blob: be31304dfad52ca5c7b024a93a7dc2b5e08638e9 [file] [log] [blame]
James Ketrenos43f66a62005-03-25 12:31:53 -06001/******************************************************************************
Jeff Garzikbf794512005-07-31 13:07:26 -04002
Zhu Yi171e7b22006-02-15 07:17:56 +08003 Copyright(c) 2003 - 2006 Intel Corporation. All rights reserved.
James Ketrenos43f66a62005-03-25 12:31:53 -06004
5 802.11 status code portion of this file from ethereal-0.10.6:
6 Copyright 2000, Axis Communications AB
7 Ethereal - Network traffic analyzer
8 By Gerald Combs <gerald@ethereal.com>
9 Copyright 1998 Gerald Combs
10
Jeff Garzikbf794512005-07-31 13:07:26 -040011 This program is free software; you can redistribute it and/or modify it
12 under the terms of version 2 of the GNU General Public License as
James Ketrenos43f66a62005-03-25 12:31:53 -060013 published by the Free Software Foundation.
Jeff Garzikbf794512005-07-31 13:07:26 -040014
15 This program is distributed in the hope that it will be useful, but WITHOUT
16 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
James Ketrenos43f66a62005-03-25 12:31:53 -060018 more details.
Jeff Garzikbf794512005-07-31 13:07:26 -040019
James Ketrenos43f66a62005-03-25 12:31:53 -060020 You should have received a copy of the GNU General Public License along with
Jeff Garzikbf794512005-07-31 13:07:26 -040021 this program; if not, write to the Free Software Foundation, Inc., 59
James Ketrenos43f66a62005-03-25 12:31:53 -060022 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
Jeff Garzikbf794512005-07-31 13:07:26 -040023
James Ketrenos43f66a62005-03-25 12:31:53 -060024 The full GNU General Public License is included in this distribution in the
25 file called LICENSE.
Jeff Garzikbf794512005-07-31 13:07:26 -040026
James Ketrenos43f66a62005-03-25 12:31:53 -060027 Contact Information:
28 James P. Ketrenos <ipw2100-admin@linux.intel.com>
29 Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30
31******************************************************************************/
32
33#include "ipw2200.h"
Olaf Hering733482e2005-11-08 21:34:55 -080034#include <linux/version.h>
James Ketrenos43f66a62005-03-25 12:31:53 -060035
Zhu Yiae4af612006-04-13 17:20:34 +080036
37#ifndef KBUILD_EXTMOD
38#define VK "k"
39#else
40#define VK
41#endif
42
43#ifdef CONFIG_IPW2200_DEBUG
44#define VD "d"
45#else
46#define VD
47#endif
48
49#ifdef CONFIG_IPW2200_MONITOR
50#define VM "m"
51#else
52#define VM
53#endif
54
55#ifdef CONFIG_IPW2200_PROMISCUOUS
56#define VP "p"
57#else
58#define VP
59#endif
60
Zhu Yi459d4082006-04-13 17:21:00 +080061#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yiae4af612006-04-13 17:20:34 +080062#define VR "r"
63#else
64#define VR
65#endif
66
67#ifdef CONFIG_IPW2200_QOS
68#define VQ "q"
69#else
70#define VQ
71#endif
72
Zhu Yiee2c4ad2007-07-12 16:09:47 +080073#define IPW2200_VERSION "1.2.2" VK VD VM VP VR VQ
James Ketrenos43f66a62005-03-25 12:31:53 -060074#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2200/2915 Network Driver"
Zhu Yi171e7b22006-02-15 07:17:56 +080075#define DRV_COPYRIGHT "Copyright(c) 2003-2006 Intel Corporation"
James Ketrenos43f66a62005-03-25 12:31:53 -060076#define DRV_VERSION IPW2200_VERSION
77
James Ketrenosb095c382005-08-24 22:04:42 -050078#define ETH_P_80211_STATS (ETH_P_80211_RAW + 1)
79
James Ketrenos43f66a62005-03-25 12:31:53 -060080MODULE_DESCRIPTION(DRV_DESCRIPTION);
81MODULE_VERSION(DRV_VERSION);
82MODULE_AUTHOR(DRV_COPYRIGHT);
83MODULE_LICENSE("GPL");
84
James Ketrenosf6c5cb72005-08-25 00:39:09 -050085static int cmdlog = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060086static int debug = 0;
87static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060088static int mode = 0;
89
90static u32 ipw_debug_level;
91static int associate = 1;
92static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050093static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060094static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080095static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080096static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080097static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -060098static const char ipw_modes[] = {
99 'a', 'b', 'g', '?'
100};
Zhu Yid2b83e12006-04-13 17:19:36 +0800101static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600102
Zhu Yid685b8c2006-04-13 17:20:27 +0800103#ifdef CONFIG_IPW2200_PROMISCUOUS
104static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
105#endif
106
107
Zhu Yie43e3c12006-04-13 17:20:45 +0800108#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500109static int qos_enable = 0;
110static int qos_burst_enable = 0;
111static int qos_no_ack_mask = 0;
112static int burst_duration_CCK = 0;
113static int burst_duration_OFDM = 0;
114
115static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
116 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
117 QOS_TX3_CW_MIN_OFDM},
118 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
119 QOS_TX3_CW_MAX_OFDM},
120 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
121 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
122 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
123 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
124};
125
126static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
127 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
128 QOS_TX3_CW_MIN_CCK},
129 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
130 QOS_TX3_CW_MAX_CCK},
131 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
132 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
133 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
134 QOS_TX3_TXOP_LIMIT_CCK}
135};
136
137static struct ieee80211_qos_parameters def_parameters_OFDM = {
138 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
139 DEF_TX3_CW_MIN_OFDM},
140 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
141 DEF_TX3_CW_MAX_OFDM},
142 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
143 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
144 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
145 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
146};
147
148static struct ieee80211_qos_parameters def_parameters_CCK = {
149 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
150 DEF_TX3_CW_MIN_CCK},
151 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
152 DEF_TX3_CW_MAX_CCK},
153 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
154 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
155 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
156 DEF_TX3_TXOP_LIMIT_CCK}
157};
158
159static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
160
161static int from_priority_to_tx_queue[] = {
162 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
163 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
164};
165
166static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
167
168static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
169 *qos_param);
170static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
171 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800172#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500173
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000174static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500175static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600176static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400177static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600178 struct clx2_tx_queue *txq, int qindex);
179static int ipw_queue_reset(struct ipw_priv *priv);
180
181static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
182 int len, int sync);
183
184static void ipw_tx_queue_free(struct ipw_priv *);
185
186static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
187static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
188static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600189static int ipw_up(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000190static void ipw_bg_up(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600191static void ipw_down(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000192static void ipw_bg_down(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600193static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400194static int init_supported_rates(struct ipw_priv *priv,
195 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500196static void ipw_set_hwcrypto_keys(struct ipw_priv *);
197static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600198
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500199static int snprint_line(char *buf, size_t count,
200 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600201{
202 int out, i, j, l;
203 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400204
James Ketrenos43f66a62005-03-25 12:31:53 -0600205 out = snprintf(buf, count, "%08X", ofs);
206
207 for (l = 0, i = 0; i < 2; i++) {
208 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400209 for (j = 0; j < 8 && l < len; j++, l++)
210 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600211 data[(i * 8 + j)]);
212 for (; j < 8; j++)
213 out += snprintf(buf + out, count - out, " ");
214 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400215
James Ketrenos43f66a62005-03-25 12:31:53 -0600216 out += snprintf(buf + out, count - out, " ");
217 for (l = 0, i = 0; i < 2; i++) {
218 out += snprintf(buf + out, count - out, " ");
219 for (j = 0; j < 8 && l < len; j++, l++) {
220 c = data[(i * 8 + j)];
221 if (!isascii(c) || !isprint(c))
222 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400223
James Ketrenos43f66a62005-03-25 12:31:53 -0600224 out += snprintf(buf + out, count - out, "%c", c);
225 }
226
227 for (; j < 8; j++)
228 out += snprintf(buf + out, count - out, " ");
229 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400230
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500231 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600232}
233
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400234static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600235{
236 char line[81];
237 u32 ofs = 0;
238 if (!(ipw_debug_level & level))
239 return;
240
241 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500242 snprint_line(line, sizeof(line), &data[ofs],
243 min(len, 16U), ofs);
244 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600245 ofs += 16;
246 len -= min(len, 16U);
247 }
248}
249
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500250static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
251{
252 size_t out = size;
253 u32 ofs = 0;
254 int total = 0;
255
256 while (size && len) {
257 out = snprint_line(output, size, &data[ofs],
258 min_t(size_t, len, 16U), ofs);
259
260 ofs += 16;
261 output += out;
262 size -= out;
263 len -= min_t(size_t, len, 16U);
264 total += out;
265 }
266 return total;
267}
268
Zhu Yic8fe6672006-01-24 16:36:36 +0800269/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600270static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
271#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
272
Zhu Yic8fe6672006-01-24 16:36:36 +0800273/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600274static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
275#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
276
Zhu Yic8fe6672006-01-24 16:36:36 +0800277/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600278static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
279static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
280{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400281 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
282 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600283 _ipw_write_reg8(a, b, c);
284}
285
Zhu Yic8fe6672006-01-24 16:36:36 +0800286/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600287static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
288static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
289{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400290 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
291 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600292 _ipw_write_reg16(a, b, c);
293}
294
Zhu Yic8fe6672006-01-24 16:36:36 +0800295/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600296static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
297static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
298{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400299 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
300 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600301 _ipw_write_reg32(a, b, c);
302}
303
Zhu Yic8fe6672006-01-24 16:36:36 +0800304/* 8-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600305#define _ipw_write8(ipw, ofs, val) writeb((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800306
307/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600308#define ipw_write8(ipw, ofs, val) \
309 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
310 _ipw_write8(ipw, ofs, val)
311
Zhu Yic8fe6672006-01-24 16:36:36 +0800312/* 16-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600313#define _ipw_write16(ipw, ofs, val) writew((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800314
315/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600316#define ipw_write16(ipw, ofs, val) \
317 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
318 _ipw_write16(ipw, ofs, val)
319
Zhu Yic8fe6672006-01-24 16:36:36 +0800320/* 32-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600321#define _ipw_write32(ipw, ofs, val) writel((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800322
323/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600324#define ipw_write32(ipw, ofs, val) \
325 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
326 _ipw_write32(ipw, ofs, val)
327
Zhu Yic8fe6672006-01-24 16:36:36 +0800328/* 8-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600329#define _ipw_read8(ipw, ofs) readb((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800330
331/* 8-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400332static inline u8 __ipw_read8(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
333{
334 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600335 return _ipw_read8(ipw, ofs);
336}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400337
Zhu Yic8fe6672006-01-24 16:36:36 +0800338/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600339#define ipw_read8(ipw, ofs) __ipw_read8(__FILE__, __LINE__, ipw, ofs)
340
Zhu Yic8fe6672006-01-24 16:36:36 +0800341/* 16-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600342#define _ipw_read16(ipw, ofs) readw((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800343
344/* 16-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400345static inline u16 __ipw_read16(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
346{
347 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600348 return _ipw_read16(ipw, ofs);
349}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400350
Zhu Yic8fe6672006-01-24 16:36:36 +0800351/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600352#define ipw_read16(ipw, ofs) __ipw_read16(__FILE__, __LINE__, ipw, ofs)
353
Zhu Yic8fe6672006-01-24 16:36:36 +0800354/* 32-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600355#define _ipw_read32(ipw, ofs) readl((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800356
357/* 32-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400358static inline u32 __ipw_read32(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
359{
360 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600361 return _ipw_read32(ipw, ofs);
362}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400363
Zhu Yic8fe6672006-01-24 16:36:36 +0800364/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600365#define ipw_read32(ipw, ofs) __ipw_read32(__FILE__, __LINE__, ipw, ofs)
366
Zhu Yic8fe6672006-01-24 16:36:36 +0800367/* multi-byte read (above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600368static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500369static inline void __ipw_read_indirect(const char *f, int l,
370 struct ipw_priv *a, u32 b, u8 * c, int d)
371{
372 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %d bytes\n", f, l, (u32) (b),
373 d);
374 _ipw_read_indirect(a, b, c, d);
375}
376
Zhu Yic8fe6672006-01-24 16:36:36 +0800377/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500378#define ipw_read_indirect(a, b, c, d) __ipw_read_indirect(__FILE__, __LINE__, a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600379
Zhu Yic8fe6672006-01-24 16:36:36 +0800380/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400381static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
382 int num);
James Ketrenos43f66a62005-03-25 12:31:53 -0600383#define ipw_write_indirect(a, b, c, d) \
384 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %d bytes\n", __FILE__, __LINE__, (u32)(b), d); \
James Ketrenosafbf30a2005-08-25 00:05:33 -0500385 _ipw_write_indirect(a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600386
Zhu Yic8fe6672006-01-24 16:36:36 +0800387/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400388static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600389{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400390 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500391 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
392 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600393}
394
Zhu Yic8fe6672006-01-24 16:36:36 +0800395/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600396static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
397{
Zhu Yi2638bc32006-01-24 16:37:52 +0800398 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800399 u32 dif_len = reg - aligned_addr;
400
James Ketrenos43f66a62005-03-25 12:31:53 -0600401 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800402 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
403 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600404}
405
Zhu Yic8fe6672006-01-24 16:36:36 +0800406/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400407static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600408{
Zhu Yi2638bc32006-01-24 16:37:52 +0800409 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800410 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
411
James Ketrenos43f66a62005-03-25 12:31:53 -0600412 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800413 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
414 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600415}
416
Zhu Yic8fe6672006-01-24 16:36:36 +0800417/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600418static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
419{
420 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500421 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600422 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500423 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400424 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600425}
426
Zhu Yic8fe6672006-01-24 16:36:36 +0800427/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600428static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
429{
430 u32 value;
431
432 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
433
James Ketrenosb095c382005-08-24 22:04:42 -0500434 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
435 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600436 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
437 return value;
438}
439
Zhu Yic8fe6672006-01-24 16:36:36 +0800440/* General purpose, no alignment requirement, iterative (multi-byte) read, */
441/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600442static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
443 int num)
444{
Zhu Yi2638bc32006-01-24 16:37:52 +0800445 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600446 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600447 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400448
James Ketrenos43f66a62005-03-25 12:31:53 -0600449 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
450
James Ketrenosea2b26e2005-08-24 21:25:16 -0500451 if (num <= 0) {
452 return;
453 }
454
Zhu Yic8fe6672006-01-24 16:36:36 +0800455 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600456 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500457 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600458 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500459 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500460 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600461 aligned_addr += 4;
462 }
463
Zhu Yic8fe6672006-01-24 16:36:36 +0800464 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500465 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500466 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500467 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400468
Zhu Yic8fe6672006-01-24 16:36:36 +0800469 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500470 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500471 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500472 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500473 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500474 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600475}
476
Zhu Yic8fe6672006-01-24 16:36:36 +0800477/* General purpose, no alignment requirement, iterative (multi-byte) write, */
478/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400479static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600480 int num)
481{
Zhu Yi2638bc32006-01-24 16:37:52 +0800482 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600483 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600484 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400485
James Ketrenos43f66a62005-03-25 12:31:53 -0600486 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400487
James Ketrenosea2b26e2005-08-24 21:25:16 -0500488 if (num <= 0) {
489 return;
490 }
491
Zhu Yic8fe6672006-01-24 16:36:36 +0800492 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600493 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500494 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800495 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500496 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500497 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600498 aligned_addr += 4;
499 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400500
Zhu Yic8fe6672006-01-24 16:36:36 +0800501 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500502 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500503 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500504 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400505
Zhu Yic8fe6672006-01-24 16:36:36 +0800506 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500507 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500508 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500509 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500510 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500511 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600512}
513
Zhu Yic8fe6672006-01-24 16:36:36 +0800514/* General purpose, no alignment requirement, iterative (multi-byte) write, */
515/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400516static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600517 int num)
518{
519 memcpy_toio((priv->hw_base + addr), buf, num);
520}
521
Zhu Yic8fe6672006-01-24 16:36:36 +0800522/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600523static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
524{
525 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
526}
527
Zhu Yic8fe6672006-01-24 16:36:36 +0800528/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600529static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
530{
531 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
532}
533
Zhu Yi89c318e2006-06-08 22:19:49 -0700534static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600535{
536 if (priv->status & STATUS_INT_ENABLED)
537 return;
538 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500539 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600540}
541
Zhu Yi89c318e2006-06-08 22:19:49 -0700542static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600543{
544 if (!(priv->status & STATUS_INT_ENABLED))
545 return;
546 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500547 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600548}
549
Zhu Yi89c318e2006-06-08 22:19:49 -0700550static inline void ipw_enable_interrupts(struct ipw_priv *priv)
551{
552 unsigned long flags;
553
554 spin_lock_irqsave(&priv->irq_lock, flags);
555 __ipw_enable_interrupts(priv);
556 spin_unlock_irqrestore(&priv->irq_lock, flags);
557}
558
559static inline void ipw_disable_interrupts(struct ipw_priv *priv)
560{
561 unsigned long flags;
562
563 spin_lock_irqsave(&priv->irq_lock, flags);
564 __ipw_disable_interrupts(priv);
565 spin_unlock_irqrestore(&priv->irq_lock, flags);
566}
567
James Ketrenos43f66a62005-03-25 12:31:53 -0600568static char *ipw_error_desc(u32 val)
569{
570 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400571 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600572 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400573 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600574 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400575 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600576 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400577 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600578 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400579 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500580 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400581 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500582 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400583 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500584 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500586 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500588 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500590 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500592 return "DMA_STATUS";
593 case IPW_FW_ERROR_DINO_ERROR:
594 return "DINO_ERROR";
595 case IPW_FW_ERROR_EEPROM_ERROR:
596 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400597 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500598 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600603 }
604}
605
James Ketrenosb39860c2005-08-12 09:36:32 -0500606static void ipw_dump_error_log(struct ipw_priv *priv,
607 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600608{
James Ketrenosb39860c2005-08-12 09:36:32 -0500609 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600610
James Ketrenosb39860c2005-08-12 09:36:32 -0500611 if (!error) {
612 IPW_ERROR("Error allocating and capturing error log. "
613 "Nothing to dump.\n");
614 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600615 }
616
James Ketrenosb39860c2005-08-12 09:36:32 -0500617 IPW_ERROR("Start IPW Error Log Dump:\n");
618 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
619 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600620
James Ketrenosb39860c2005-08-12 09:36:32 -0500621 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400622 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 ipw_error_desc(error->elem[i].desc),
624 error->elem[i].time,
625 error->elem[i].blink1,
626 error->elem[i].blink2,
627 error->elem[i].link1,
628 error->elem[i].link2, error->elem[i].data);
629 for (i = 0; i < error->log_len; i++)
630 IPW_ERROR("%i\t0x%08x\t%i\n",
631 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500632 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600633}
James Ketrenos43f66a62005-03-25 12:31:53 -0600634
James Ketrenosc848d0a2005-08-24 21:56:24 -0500635static inline int ipw_is_init(struct ipw_priv *priv)
636{
637 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600638}
639
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400640static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600641{
642 u32 addr, field_info, field_len, field_count, total_len;
643
644 IPW_DEBUG_ORD("ordinal = %i\n", ord);
645
646 if (!priv || !val || !len) {
647 IPW_DEBUG_ORD("Invalid argument\n");
648 return -EINVAL;
649 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400650
James Ketrenos43f66a62005-03-25 12:31:53 -0600651 /* verify device ordinal tables have been initialized */
652 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
653 IPW_DEBUG_ORD("Access ordinals before initialization\n");
654 return -EINVAL;
655 }
656
657 switch (IPW_ORD_TABLE_ID_MASK & ord) {
658 case IPW_ORD_TABLE_0_MASK:
659 /*
660 * TABLE 0: Direct access to a table of 32 bit values
661 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400662 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600663 * read from the table
664 */
665
666 /* remove the table id from the ordinal */
667 ord &= IPW_ORD_TABLE_VALUE_MASK;
668
669 /* boundary check */
670 if (ord > priv->table0_len) {
671 IPW_DEBUG_ORD("ordinal value (%i) longer then "
672 "max (%i)\n", ord, priv->table0_len);
673 return -EINVAL;
674 }
675
676 /* verify we have enough room to store the value */
677 if (*len < sizeof(u32)) {
678 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200679 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600680 return -EINVAL;
681 }
682
683 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400684 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600685
686 *len = sizeof(u32);
687 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400688 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600689 break;
690
691 case IPW_ORD_TABLE_1_MASK:
692 /*
693 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400694 *
695 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600696 * representing starting addr for the data (which is
697 * also a u32)
698 */
699
700 /* remove the table id from the ordinal */
701 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400702
James Ketrenos43f66a62005-03-25 12:31:53 -0600703 /* boundary check */
704 if (ord > priv->table1_len) {
705 IPW_DEBUG_ORD("ordinal value too long\n");
706 return -EINVAL;
707 }
708
709 /* verify we have enough room to store the value */
710 if (*len < sizeof(u32)) {
711 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200712 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600713 return -EINVAL;
714 }
715
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400716 *((u32 *) val) =
717 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600718 *len = sizeof(u32);
719 break;
720
721 case IPW_ORD_TABLE_2_MASK:
722 /*
723 * TABLE 2: Indirect access to a table of variable sized values
724 *
725 * This table consist of six values, each containing
726 * - dword containing the starting offset of the data
727 * - dword containing the lengh in the first 16bits
728 * and the count in the second 16bits
729 */
730
731 /* remove the table id from the ordinal */
732 ord &= IPW_ORD_TABLE_VALUE_MASK;
733
734 /* boundary check */
735 if (ord > priv->table2_len) {
736 IPW_DEBUG_ORD("ordinal value too long\n");
737 return -EINVAL;
738 }
739
740 /* get the address of statistic */
741 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400742
743 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600744 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400745 field_info =
746 ipw_read_reg32(priv,
747 priv->table2_addr + (ord << 3) +
748 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400749
James Ketrenos43f66a62005-03-25 12:31:53 -0600750 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400751 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400752
James Ketrenos43f66a62005-03-25 12:31:53 -0600753 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400754 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400755
James Ketrenos43f66a62005-03-25 12:31:53 -0600756 /* abort if not enought memory */
757 total_len = field_len * field_count;
758 if (total_len > *len) {
759 *len = total_len;
760 return -EINVAL;
761 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400762
James Ketrenos43f66a62005-03-25 12:31:53 -0600763 *len = total_len;
764 if (!total_len)
765 return 0;
766
767 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400768 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600769 addr, total_len, field_info);
770 ipw_read_indirect(priv, addr, val, total_len);
771 break;
772
773 default:
774 IPW_DEBUG_ORD("Invalid ordinal!\n");
775 return -EINVAL;
776
777 }
778
James Ketrenos43f66a62005-03-25 12:31:53 -0600779 return 0;
780}
781
782static void ipw_init_ordinals(struct ipw_priv *priv)
783{
784 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400785 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600786
787 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
788 priv->table0_addr, priv->table0_len);
789
790 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
791 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
792
793 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
794 priv->table1_addr, priv->table1_len);
795
796 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
797 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400798 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600799
800 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
801 priv->table2_addr, priv->table2_len);
802
803}
804
Adrian Bunka73e22b2006-01-21 01:39:42 +0100805static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500806{
James Ketrenosb095c382005-08-24 22:04:42 -0500807 reg &= ~IPW_START_STANDBY;
808 if (reg & IPW_GATE_ODMA)
809 reg &= ~IPW_GATE_ODMA;
810 if (reg & IPW_GATE_IDMA)
811 reg &= ~IPW_GATE_IDMA;
812 if (reg & IPW_GATE_ADMA)
813 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500814 return reg;
815}
816
817/*
818 * LED behavior:
819 * - On radio ON, turn on any LEDs that require to be on during start
820 * - On initialization, start unassociated blink
821 * - On association, disable unassociated blink
822 * - On disassociation, start unassociated blink
823 * - On radio OFF, turn off any LEDs started during radio on
824 *
825 */
Zhu Yiede61112006-01-24 16:37:10 +0800826#define LD_TIME_LINK_ON msecs_to_jiffies(300)
827#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
828#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500829
Adrian Bunka73e22b2006-01-21 01:39:42 +0100830static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500831{
832 unsigned long flags;
833 u32 led;
834
835 /* If configured to not use LEDs, or nic_type is 1,
836 * then we don't toggle a LINK led */
837 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
838 return;
839
840 spin_lock_irqsave(&priv->lock, flags);
841
842 if (!(priv->status & STATUS_RF_KILL_MASK) &&
843 !(priv->status & STATUS_LED_LINK_ON)) {
844 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500845 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500846 led |= priv->led_association_on;
847
848 led = ipw_register_toggle(led);
849
850 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500851 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500852
853 priv->status |= STATUS_LED_LINK_ON;
854
855 /* If we aren't associated, schedule turning the LED off */
856 if (!(priv->status & STATUS_ASSOCIATED))
857 queue_delayed_work(priv->workqueue,
858 &priv->led_link_off,
859 LD_TIME_LINK_ON);
860 }
861
862 spin_unlock_irqrestore(&priv->lock, flags);
863}
864
David Howellsc4028952006-11-22 14:57:56 +0000865static void ipw_bg_led_link_on(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500866{
David Howellsc4028952006-11-22 14:57:56 +0000867 struct ipw_priv *priv =
868 container_of(work, struct ipw_priv, led_link_on.work);
Zhu Yi46441512006-01-24 16:37:59 +0800869 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000870 ipw_led_link_on(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800871 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500872}
873
Adrian Bunka73e22b2006-01-21 01:39:42 +0100874static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500875{
876 unsigned long flags;
877 u32 led;
878
879 /* If configured not to use LEDs, or nic type is 1,
880 * then we don't goggle the LINK led. */
881 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
882 return;
883
884 spin_lock_irqsave(&priv->lock, flags);
885
886 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500887 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500888 led &= priv->led_association_off;
889 led = ipw_register_toggle(led);
890
891 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500892 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500893
894 IPW_DEBUG_LED("Link LED Off\n");
895
896 priv->status &= ~STATUS_LED_LINK_ON;
897
898 /* If we aren't associated and the radio is on, schedule
899 * turning the LED on (blink while unassociated) */
900 if (!(priv->status & STATUS_RF_KILL_MASK) &&
901 !(priv->status & STATUS_ASSOCIATED))
902 queue_delayed_work(priv->workqueue, &priv->led_link_on,
903 LD_TIME_LINK_OFF);
904
905 }
906
907 spin_unlock_irqrestore(&priv->lock, flags);
908}
909
David Howellsc4028952006-11-22 14:57:56 +0000910static void ipw_bg_led_link_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500911{
David Howellsc4028952006-11-22 14:57:56 +0000912 struct ipw_priv *priv =
913 container_of(work, struct ipw_priv, led_link_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800914 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000915 ipw_led_link_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800916 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500917}
918
Arjan van de Ven858119e2006-01-14 13:20:43 -0800919static void __ipw_led_activity_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500920{
James Ketrenosa613bff2005-08-24 21:43:11 -0500921 u32 led;
922
923 if (priv->config & CFG_NO_LED)
924 return;
925
James Ketrenosb095c382005-08-24 22:04:42 -0500926 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -0500927 return;
James Ketrenosa613bff2005-08-24 21:43:11 -0500928
929 if (!(priv->status & STATUS_LED_ACT_ON)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500930 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500931 led |= priv->led_activity_on;
932
933 led = ipw_register_toggle(led);
934
935 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500936 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500937
938 IPW_DEBUG_LED("Activity LED On\n");
939
940 priv->status |= STATUS_LED_ACT_ON;
941
James Ketrenosc848d0a2005-08-24 21:56:24 -0500942 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -0500943 queue_delayed_work(priv->workqueue, &priv->led_act_off,
944 LD_TIME_ACT_ON);
945 } else {
946 /* Reschedule LED off for full time period */
947 cancel_delayed_work(&priv->led_act_off);
948 queue_delayed_work(priv->workqueue, &priv->led_act_off,
949 LD_TIME_ACT_ON);
950 }
James Ketrenosb095c382005-08-24 22:04:42 -0500951}
James Ketrenosa613bff2005-08-24 21:43:11 -0500952
Adrian Bunka73e22b2006-01-21 01:39:42 +0100953#if 0
James Ketrenosb095c382005-08-24 22:04:42 -0500954void ipw_led_activity_on(struct ipw_priv *priv)
955{
956 unsigned long flags;
957 spin_lock_irqsave(&priv->lock, flags);
958 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -0500959 spin_unlock_irqrestore(&priv->lock, flags);
960}
Adrian Bunka73e22b2006-01-21 01:39:42 +0100961#endif /* 0 */
James Ketrenosa613bff2005-08-24 21:43:11 -0500962
Adrian Bunka73e22b2006-01-21 01:39:42 +0100963static void ipw_led_activity_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500964{
965 unsigned long flags;
966 u32 led;
967
968 if (priv->config & CFG_NO_LED)
969 return;
970
971 spin_lock_irqsave(&priv->lock, flags);
972
973 if (priv->status & STATUS_LED_ACT_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500974 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500975 led &= priv->led_activity_off;
976
977 led = ipw_register_toggle(led);
978
979 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500980 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500981
982 IPW_DEBUG_LED("Activity LED Off\n");
983
984 priv->status &= ~STATUS_LED_ACT_ON;
985 }
986
987 spin_unlock_irqrestore(&priv->lock, flags);
988}
989
David Howellsc4028952006-11-22 14:57:56 +0000990static void ipw_bg_led_activity_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500991{
David Howellsc4028952006-11-22 14:57:56 +0000992 struct ipw_priv *priv =
993 container_of(work, struct ipw_priv, led_act_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800994 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000995 ipw_led_activity_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800996 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500997}
998
Adrian Bunka73e22b2006-01-21 01:39:42 +0100999static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001000{
1001 unsigned long flags;
1002 u32 led;
1003
1004 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001005 if (priv->config & CFG_NO_LED ||
1006 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001007 return;
1008
1009 spin_lock_irqsave(&priv->lock, flags);
1010
James Ketrenosb095c382005-08-24 22:04:42 -05001011 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001012 if (priv->assoc_network->mode == IEEE_A) {
1013 led |= priv->led_ofdm_on;
1014 led &= priv->led_association_off;
1015 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1016 } else if (priv->assoc_network->mode == IEEE_G) {
1017 led |= priv->led_ofdm_on;
1018 led |= priv->led_association_on;
1019 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1020 } else {
1021 led &= priv->led_ofdm_off;
1022 led |= priv->led_association_on;
1023 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1024 }
1025
1026 led = ipw_register_toggle(led);
1027
1028 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001029 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001030
1031 spin_unlock_irqrestore(&priv->lock, flags);
1032}
1033
Adrian Bunka73e22b2006-01-21 01:39:42 +01001034static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001035{
1036 unsigned long flags;
1037 u32 led;
1038
1039 /* Only nic type 1 supports mode LEDs */
1040 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1041 return;
1042
1043 spin_lock_irqsave(&priv->lock, flags);
1044
James Ketrenosb095c382005-08-24 22:04:42 -05001045 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001046 led &= priv->led_ofdm_off;
1047 led &= priv->led_association_off;
1048
1049 led = ipw_register_toggle(led);
1050
1051 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001052 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001053
1054 spin_unlock_irqrestore(&priv->lock, flags);
1055}
1056
Adrian Bunka73e22b2006-01-21 01:39:42 +01001057static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001058{
1059 ipw_led_link_on(priv);
1060}
1061
Adrian Bunka73e22b2006-01-21 01:39:42 +01001062static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001063{
1064 ipw_led_activity_off(priv);
1065 ipw_led_link_off(priv);
1066}
1067
Adrian Bunka73e22b2006-01-21 01:39:42 +01001068static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001069{
1070 /* Set the Link Led on for all nic types */
1071 ipw_led_link_on(priv);
1072}
1073
Adrian Bunka73e22b2006-01-21 01:39:42 +01001074static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001075{
1076 ipw_led_activity_off(priv);
1077 ipw_led_link_off(priv);
1078
1079 if (priv->status & STATUS_RF_KILL_MASK)
1080 ipw_led_radio_off(priv);
1081}
1082
Adrian Bunka73e22b2006-01-21 01:39:42 +01001083static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001084{
1085 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1086
1087 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001088 priv->led_activity_on = IPW_ACTIVITY_LED;
1089 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001090
James Ketrenosb095c382005-08-24 22:04:42 -05001091 priv->led_association_on = IPW_ASSOCIATED_LED;
1092 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001093
1094 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001095 priv->led_ofdm_on = IPW_OFDM_LED;
1096 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001097
1098 switch (priv->nic_type) {
1099 case EEPROM_NIC_TYPE_1:
1100 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001101 priv->led_activity_on = IPW_ASSOCIATED_LED;
1102 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1103 priv->led_association_on = IPW_ACTIVITY_LED;
1104 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001105
1106 if (!(priv->config & CFG_NO_LED))
1107 ipw_led_band_on(priv);
1108
1109 /* And we don't blink link LEDs for this nic, so
1110 * just return here */
1111 return;
1112
1113 case EEPROM_NIC_TYPE_3:
1114 case EEPROM_NIC_TYPE_2:
1115 case EEPROM_NIC_TYPE_4:
1116 case EEPROM_NIC_TYPE_0:
1117 break;
1118
1119 default:
1120 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1121 priv->nic_type);
1122 priv->nic_type = EEPROM_NIC_TYPE_0;
1123 break;
1124 }
1125
1126 if (!(priv->config & CFG_NO_LED)) {
1127 if (priv->status & STATUS_ASSOCIATED)
1128 ipw_led_link_on(priv);
1129 else
1130 ipw_led_link_off(priv);
1131 }
1132}
1133
Adrian Bunka73e22b2006-01-21 01:39:42 +01001134static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001135{
James Ketrenosa613bff2005-08-24 21:43:11 -05001136 ipw_led_activity_off(priv);
1137 ipw_led_link_off(priv);
1138 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001139 cancel_delayed_work(&priv->led_link_on);
1140 cancel_delayed_work(&priv->led_link_off);
1141 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001142}
1143
James Ketrenos43f66a62005-03-25 12:31:53 -06001144/*
1145 * The following adds a new attribute to the sysfs representation
1146 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1147 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001148 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001149 * See the level definitions in ipw for details.
1150 */
1151static ssize_t show_debug_level(struct device_driver *d, char *buf)
1152{
1153 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1154}
James Ketrenosa613bff2005-08-24 21:43:11 -05001155
1156static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1157 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001158{
1159 char *p = (char *)buf;
1160 u32 val;
1161
1162 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1163 p++;
1164 if (p[0] == 'x' || p[0] == 'X')
1165 p++;
1166 val = simple_strtoul(p, &p, 16);
1167 } else
1168 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001169 if (p == buf)
1170 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001171 ": %s is not in hex or decimal form.\n", buf);
1172 else
1173 ipw_debug_level = val;
1174
1175 return strnlen(buf, count);
1176}
1177
Jeff Garzikbf794512005-07-31 13:07:26 -04001178static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001179 show_debug_level, store_debug_level);
1180
James Ketrenosb39860c2005-08-12 09:36:32 -05001181static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1182{
Zhu Yic8fe6672006-01-24 16:36:36 +08001183 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001184 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1185}
1186
1187static void ipw_capture_event_log(struct ipw_priv *priv,
1188 u32 log_len, struct ipw_event *log)
1189{
1190 u32 base;
1191
1192 if (log_len) {
1193 base = ipw_read32(priv, IPW_EVENT_LOG);
1194 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1195 (u8 *) log, sizeof(*log) * log_len);
1196 }
1197}
1198
1199static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1200{
1201 struct ipw_fw_error *error;
1202 u32 log_len = ipw_get_event_log_len(priv);
1203 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1204 u32 elem_len = ipw_read_reg32(priv, base);
1205
1206 error = kmalloc(sizeof(*error) +
1207 sizeof(*error->elem) * elem_len +
1208 sizeof(*error->log) * log_len, GFP_ATOMIC);
1209 if (!error) {
1210 IPW_ERROR("Memory allocation for firmware error log "
1211 "failed.\n");
1212 return NULL;
1213 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001214 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001215 error->status = priv->status;
1216 error->config = priv->config;
1217 error->elem_len = elem_len;
1218 error->log_len = log_len;
1219 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001220 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001221
1222 ipw_capture_event_log(priv, log_len, error->log);
1223
1224 if (elem_len)
1225 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1226 sizeof(*error->elem) * elem_len);
1227
1228 return error;
1229}
1230
James Ketrenosb39860c2005-08-12 09:36:32 -05001231static ssize_t show_event_log(struct device *d,
1232 struct device_attribute *attr, char *buf)
1233{
1234 struct ipw_priv *priv = dev_get_drvdata(d);
1235 u32 log_len = ipw_get_event_log_len(priv);
Reinette Chatre412e9e72007-12-18 22:01:02 -08001236 u32 log_size;
1237 struct ipw_event *log;
James Ketrenosb39860c2005-08-12 09:36:32 -05001238 u32 len = 0, i;
1239
Reinette Chatre412e9e72007-12-18 22:01:02 -08001240 /* not using min() because of its strict type checking */
1241 log_size = PAGE_SIZE / sizeof(*log) > log_len ?
1242 sizeof(*log) * log_len : PAGE_SIZE;
1243 log = kzalloc(log_size, GFP_KERNEL);
1244 if (!log) {
1245 IPW_ERROR("Unable to allocate memory for log\n");
1246 return 0;
1247 }
1248 log_len = log_size / sizeof(*log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001249 ipw_capture_event_log(priv, log_len, log);
1250
1251 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1252 for (i = 0; i < log_len; i++)
1253 len += snprintf(buf + len, PAGE_SIZE - len,
1254 "\n%08X%08X%08X",
1255 log[i].time, log[i].event, log[i].data);
1256 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
Reinette Chatre412e9e72007-12-18 22:01:02 -08001257 kfree(log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001258 return len;
1259}
1260
1261static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1262
1263static ssize_t show_error(struct device *d,
1264 struct device_attribute *attr, char *buf)
1265{
1266 struct ipw_priv *priv = dev_get_drvdata(d);
1267 u32 len = 0, i;
1268 if (!priv->error)
1269 return 0;
1270 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001271 "%08lX%08X%08X%08X",
1272 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001273 priv->error->status,
1274 priv->error->config, priv->error->elem_len);
1275 for (i = 0; i < priv->error->elem_len; i++)
1276 len += snprintf(buf + len, PAGE_SIZE - len,
1277 "\n%08X%08X%08X%08X%08X%08X%08X",
1278 priv->error->elem[i].time,
1279 priv->error->elem[i].desc,
1280 priv->error->elem[i].blink1,
1281 priv->error->elem[i].blink2,
1282 priv->error->elem[i].link1,
1283 priv->error->elem[i].link2,
1284 priv->error->elem[i].data);
1285
1286 len += snprintf(buf + len, PAGE_SIZE - len,
1287 "\n%08X", priv->error->log_len);
1288 for (i = 0; i < priv->error->log_len; i++)
1289 len += snprintf(buf + len, PAGE_SIZE - len,
1290 "\n%08X%08X%08X",
1291 priv->error->log[i].time,
1292 priv->error->log[i].event,
1293 priv->error->log[i].data);
1294 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1295 return len;
1296}
1297
1298static ssize_t clear_error(struct device *d,
1299 struct device_attribute *attr,
1300 const char *buf, size_t count)
1301{
1302 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001303
1304 kfree(priv->error);
1305 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001306 return count;
1307}
1308
1309static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1310
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001311static ssize_t show_cmd_log(struct device *d,
1312 struct device_attribute *attr, char *buf)
1313{
1314 struct ipw_priv *priv = dev_get_drvdata(d);
1315 u32 len = 0, i;
1316 if (!priv->cmdlog)
1317 return 0;
1318 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1319 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1320 i = (i + 1) % priv->cmdlog_len) {
1321 len +=
1322 snprintf(buf + len, PAGE_SIZE - len,
1323 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1324 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1325 priv->cmdlog[i].cmd.len);
1326 len +=
1327 snprintk_buf(buf + len, PAGE_SIZE - len,
1328 (u8 *) priv->cmdlog[i].cmd.param,
1329 priv->cmdlog[i].cmd.len);
1330 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1331 }
1332 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1333 return len;
1334}
1335
1336static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1337
Zhu Yid685b8c2006-04-13 17:20:27 +08001338#ifdef CONFIG_IPW2200_PROMISCUOUS
1339static void ipw_prom_free(struct ipw_priv *priv);
1340static int ipw_prom_alloc(struct ipw_priv *priv);
1341static ssize_t store_rtap_iface(struct device *d,
1342 struct device_attribute *attr,
1343 const char *buf, size_t count)
1344{
1345 struct ipw_priv *priv = dev_get_drvdata(d);
1346 int rc = 0;
1347
1348 if (count < 1)
1349 return -EINVAL;
1350
1351 switch (buf[0]) {
1352 case '0':
1353 if (!rtap_iface)
1354 return count;
1355
1356 if (netif_running(priv->prom_net_dev)) {
1357 IPW_WARNING("Interface is up. Cannot unregister.\n");
1358 return count;
1359 }
1360
1361 ipw_prom_free(priv);
1362 rtap_iface = 0;
1363 break;
1364
1365 case '1':
1366 if (rtap_iface)
1367 return count;
1368
1369 rc = ipw_prom_alloc(priv);
1370 if (!rc)
1371 rtap_iface = 1;
1372 break;
1373
1374 default:
1375 return -EINVAL;
1376 }
1377
1378 if (rc) {
1379 IPW_ERROR("Failed to register promiscuous network "
1380 "device (error %d).\n", rc);
1381 }
1382
1383 return count;
1384}
1385
1386static ssize_t show_rtap_iface(struct device *d,
1387 struct device_attribute *attr,
1388 char *buf)
1389{
1390 struct ipw_priv *priv = dev_get_drvdata(d);
1391 if (rtap_iface)
1392 return sprintf(buf, "%s", priv->prom_net_dev->name);
1393 else {
1394 buf[0] = '-';
1395 buf[1] = '1';
1396 buf[2] = '\0';
1397 return 3;
1398 }
1399}
1400
1401static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1402 store_rtap_iface);
1403
1404static ssize_t store_rtap_filter(struct device *d,
1405 struct device_attribute *attr,
1406 const char *buf, size_t count)
1407{
1408 struct ipw_priv *priv = dev_get_drvdata(d);
1409
1410 if (!priv->prom_priv) {
1411 IPW_ERROR("Attempting to set filter without "
1412 "rtap_iface enabled.\n");
1413 return -EPERM;
1414 }
1415
1416 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1417
1418 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1419 BIT_ARG16(priv->prom_priv->filter));
1420
1421 return count;
1422}
1423
1424static ssize_t show_rtap_filter(struct device *d,
1425 struct device_attribute *attr,
1426 char *buf)
1427{
1428 struct ipw_priv *priv = dev_get_drvdata(d);
1429 return sprintf(buf, "0x%04X",
1430 priv->prom_priv ? priv->prom_priv->filter : 0);
1431}
1432
1433static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1434 store_rtap_filter);
1435#endif
1436
James Ketrenosa613bff2005-08-24 21:43:11 -05001437static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1438 char *buf)
1439{
1440 struct ipw_priv *priv = dev_get_drvdata(d);
1441 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1442}
1443
1444static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1445 const char *buf, size_t count)
1446{
1447 struct ipw_priv *priv = dev_get_drvdata(d);
1448 struct net_device *dev = priv->net_dev;
1449 char buffer[] = "00000000";
1450 unsigned long len =
1451 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1452 unsigned long val;
1453 char *p = buffer;
1454
1455 IPW_DEBUG_INFO("enter\n");
1456
1457 strncpy(buffer, buf, len);
1458 buffer[len] = 0;
1459
1460 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1461 p++;
1462 if (p[0] == 'x' || p[0] == 'X')
1463 p++;
1464 val = simple_strtoul(p, &p, 16);
1465 } else
1466 val = simple_strtoul(p, &p, 10);
1467 if (p == buffer) {
1468 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1469 } else {
1470 priv->ieee->scan_age = val;
1471 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1472 }
1473
1474 IPW_DEBUG_INFO("exit\n");
1475 return len;
1476}
1477
1478static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1479
1480static ssize_t show_led(struct device *d, struct device_attribute *attr,
1481 char *buf)
1482{
1483 struct ipw_priv *priv = dev_get_drvdata(d);
1484 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1485}
1486
1487static ssize_t store_led(struct device *d, struct device_attribute *attr,
1488 const char *buf, size_t count)
1489{
1490 struct ipw_priv *priv = dev_get_drvdata(d);
1491
1492 IPW_DEBUG_INFO("enter\n");
1493
1494 if (count == 0)
1495 return 0;
1496
1497 if (*buf == 0) {
1498 IPW_DEBUG_LED("Disabling LED control.\n");
1499 priv->config |= CFG_NO_LED;
1500 ipw_led_shutdown(priv);
1501 } else {
1502 IPW_DEBUG_LED("Enabling LED control.\n");
1503 priv->config &= ~CFG_NO_LED;
1504 ipw_led_init(priv);
1505 }
1506
1507 IPW_DEBUG_INFO("exit\n");
1508 return count;
1509}
1510
1511static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1512
Andrew Mortonad3fee52005-06-20 14:30:36 -07001513static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001514 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001515{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001516 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001517 return sprintf(buf, "0x%08x\n", (int)p->status);
1518}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001519
James Ketrenos43f66a62005-03-25 12:31:53 -06001520static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1521
Andrew Mortonad3fee52005-06-20 14:30:36 -07001522static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1523 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001524{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001525 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001526 return sprintf(buf, "0x%08x\n", (int)p->config);
1527}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001528
James Ketrenos43f66a62005-03-25 12:31:53 -06001529static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1530
Andrew Mortonad3fee52005-06-20 14:30:36 -07001531static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001532 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001533{
James Ketrenosa613bff2005-08-24 21:43:11 -05001534 struct ipw_priv *priv = d->driver_data;
1535 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001536}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001537
James Ketrenos43f66a62005-03-25 12:31:53 -06001538static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1539
Andrew Mortonad3fee52005-06-20 14:30:36 -07001540static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001541 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001542{
1543 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001544 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001545
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001546 if (ipw_get_ordinal(p, IPW_ORD_STAT_UCODE_VERSION, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001547 return 0;
1548
1549 return sprintf(buf, "0x%08x\n", tmp);
1550}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001551
1552static DEVICE_ATTR(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001553
Andrew Mortonad3fee52005-06-20 14:30:36 -07001554static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1555 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001556{
1557 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001558 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001559
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001560 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001561 return 0;
1562
1563 return sprintf(buf, "0x%08x\n", tmp);
1564}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001565
1566static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001567
1568/*
1569 * Add a device attribute to view/control the delay between eeprom
1570 * operations.
1571 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001572static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001573 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001574{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001575 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001576 return sprintf(buf, "%i\n", n);
1577}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001578static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001579 struct device_attribute *attr,
1580 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001581{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001582 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001583 sscanf(buf, "%i", &p->eeprom_delay);
1584 return strnlen(buf, count);
1585}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001586
1587static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1588 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001589
Andrew Mortonad3fee52005-06-20 14:30:36 -07001590static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001591 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001592{
1593 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001594 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001595
James Ketrenosb095c382005-08-24 22:04:42 -05001596 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001597 return sprintf(buf, "0x%08x\n", reg);
1598}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001599static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001600 struct device_attribute *attr,
1601 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001602{
1603 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001604 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001605
1606 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001607 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001608 return strnlen(buf, count);
1609}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001610
1611static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1612 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001613
Andrew Mortonad3fee52005-06-20 14:30:36 -07001614static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001615 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001616{
1617 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001618 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001619
1620 reg = ipw_read_reg32(p, 0x301100);
1621 return sprintf(buf, "0x%08x\n", reg);
1622}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001623static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001624 struct device_attribute *attr,
1625 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001626{
1627 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001628 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001629
1630 sscanf(buf, "%x", &reg);
1631 ipw_write_reg32(p, 0x301100, reg);
1632 return strnlen(buf, count);
1633}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001634
1635static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1636 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001637
Andrew Mortonad3fee52005-06-20 14:30:36 -07001638static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001639 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001640{
1641 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001642 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001643
Jeff Garzikbf794512005-07-31 13:07:26 -04001644 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001645 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001646 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001647 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001648
James Ketrenos43f66a62005-03-25 12:31:53 -06001649 return sprintf(buf, "0x%08x\n", reg);
1650}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001651static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001652 struct device_attribute *attr,
1653 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001654{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001655 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001656
1657 sscanf(buf, "%x", &priv->indirect_dword);
1658 priv->status |= STATUS_INDIRECT_DWORD;
1659 return strnlen(buf, count);
1660}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001661
1662static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1663 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001664
Andrew Mortonad3fee52005-06-20 14:30:36 -07001665static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001666 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001667{
1668 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001669 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001670
Jeff Garzikbf794512005-07-31 13:07:26 -04001671 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001672 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001673 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001674 reg = 0;
1675
1676 return sprintf(buf, "0x%02x\n", reg);
1677}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001678static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001679 struct device_attribute *attr,
1680 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001681{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001682 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001683
1684 sscanf(buf, "%x", &priv->indirect_byte);
1685 priv->status |= STATUS_INDIRECT_BYTE;
1686 return strnlen(buf, count);
1687}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001688
1689static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001690 show_indirect_byte, store_indirect_byte);
1691
Andrew Mortonad3fee52005-06-20 14:30:36 -07001692static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001693 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001694{
1695 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001696 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001697
Jeff Garzikbf794512005-07-31 13:07:26 -04001698 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001699 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001700 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001701 reg = 0;
1702
1703 return sprintf(buf, "0x%08x\n", reg);
1704}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001705static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001706 struct device_attribute *attr,
1707 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001708{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001709 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001710
1711 sscanf(buf, "%x", &priv->direct_dword);
1712 priv->status |= STATUS_DIRECT_DWORD;
1713 return strnlen(buf, count);
1714}
James Ketrenos43f66a62005-03-25 12:31:53 -06001715
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001716static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1717 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001718
Arjan van de Ven858119e2006-01-14 13:20:43 -08001719static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001720{
1721 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1722 priv->status |= STATUS_RF_KILL_HW;
1723 else
1724 priv->status &= ~STATUS_RF_KILL_HW;
1725
1726 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1727}
1728
Andrew Mortonad3fee52005-06-20 14:30:36 -07001729static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001730 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001731{
1732 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001733 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001734 2 - HW based RF kill active
1735 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001736 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001737 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001738 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001739 return sprintf(buf, "%i\n", val);
1740}
1741
1742static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1743{
Jeff Garzikbf794512005-07-31 13:07:26 -04001744 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001745 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001746 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001747
1748 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1749 disable_radio ? "OFF" : "ON");
1750
1751 if (disable_radio) {
1752 priv->status |= STATUS_RF_KILL_SW;
1753
Dan Williams0b531672007-10-09 13:55:24 -04001754 if (priv->workqueue) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001755 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -04001756 cancel_delayed_work(&priv->scan_event);
1757 }
James Ketrenos43f66a62005-03-25 12:31:53 -06001758 queue_work(priv->workqueue, &priv->down);
1759 } else {
1760 priv->status &= ~STATUS_RF_KILL_SW;
1761 if (rf_kill_active(priv)) {
1762 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1763 "disabled by HW switch\n");
1764 /* Make sure the RF_KILL check timer is running */
1765 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001766 queue_delayed_work(priv->workqueue, &priv->rf_kill,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05001767 round_jiffies_relative(2 * HZ));
Jeff Garzikbf794512005-07-31 13:07:26 -04001768 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001769 queue_work(priv->workqueue, &priv->up);
1770 }
1771
1772 return 1;
1773}
1774
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001775static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1776 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001777{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001778 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001779
James Ketrenos43f66a62005-03-25 12:31:53 -06001780 ipw_radio_kill_sw(priv, buf[0] == '1');
1781
1782 return count;
1783}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001784
1785static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001786
James Ketrenosb095c382005-08-24 22:04:42 -05001787static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1788 char *buf)
1789{
1790 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1791 int pos = 0, len = 0;
1792 if (priv->config & CFG_SPEED_SCAN) {
1793 while (priv->speed_scan[pos] != 0)
1794 len += sprintf(&buf[len], "%d ",
1795 priv->speed_scan[pos++]);
1796 return len + sprintf(&buf[len], "\n");
1797 }
1798
1799 return sprintf(buf, "0\n");
1800}
1801
1802static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1803 const char *buf, size_t count)
1804{
1805 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1806 int channel, pos = 0;
1807 const char *p = buf;
1808
1809 /* list of space separated channels to scan, optionally ending with 0 */
1810 while ((channel = simple_strtol(p, NULL, 0))) {
1811 if (pos == MAX_SPEED_SCAN - 1) {
1812 priv->speed_scan[pos] = 0;
1813 break;
1814 }
1815
Larry Finger1867b112006-02-28 09:48:28 -06001816 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001817 priv->speed_scan[pos++] = channel;
1818 else
1819 IPW_WARNING("Skipping invalid channel request: %d\n",
1820 channel);
1821 p = strchr(p, ' ');
1822 if (!p)
1823 break;
1824 while (*p == ' ' || *p == '\t')
1825 p++;
1826 }
1827
1828 if (pos == 0)
1829 priv->config &= ~CFG_SPEED_SCAN;
1830 else {
1831 priv->speed_scan_pos = 0;
1832 priv->config |= CFG_SPEED_SCAN;
1833 }
1834
1835 return count;
1836}
1837
1838static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1839 store_speed_scan);
1840
1841static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1842 char *buf)
1843{
1844 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1845 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1846}
1847
1848static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1849 const char *buf, size_t count)
1850{
1851 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1852 if (buf[0] == '1')
1853 priv->config |= CFG_NET_STATS;
1854 else
1855 priv->config &= ~CFG_NET_STATS;
1856
1857 return count;
1858}
1859
James Ketrenosafbf30a2005-08-25 00:05:33 -05001860static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1861 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001862
Zhu Yi375dd242007-02-14 16:04:24 +08001863static ssize_t show_channels(struct device *d,
1864 struct device_attribute *attr,
1865 char *buf)
1866{
1867 struct ipw_priv *priv = dev_get_drvdata(d);
Andrew Morton742e9912007-03-01 08:19:29 -05001868 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi375dd242007-02-14 16:04:24 +08001869 int len = 0, i;
1870
1871 len = sprintf(&buf[len],
1872 "Displaying %d channels in 2.4Ghz band "
1873 "(802.11bg):\n", geo->bg_channels);
1874
1875 for (i = 0; i < geo->bg_channels; i++) {
1876 len += sprintf(&buf[len], "%d: BSS%s%s, %s, Band %s.\n",
1877 geo->bg[i].channel,
1878 geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT ?
1879 " (radar spectrum)" : "",
1880 ((geo->bg[i].flags & IEEE80211_CH_NO_IBSS) ||
1881 (geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT))
1882 ? "" : ", IBSS",
1883 geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1884 "passive only" : "active/passive",
1885 geo->bg[i].flags & IEEE80211_CH_B_ONLY ?
1886 "B" : "B/G");
1887 }
1888
1889 len += sprintf(&buf[len],
1890 "Displaying %d channels in 5.2Ghz band "
1891 "(802.11a):\n", geo->a_channels);
1892 for (i = 0; i < geo->a_channels; i++) {
1893 len += sprintf(&buf[len], "%d: BSS%s%s, %s.\n",
1894 geo->a[i].channel,
1895 geo->a[i].flags & IEEE80211_CH_RADAR_DETECT ?
1896 " (radar spectrum)" : "",
1897 ((geo->a[i].flags & IEEE80211_CH_NO_IBSS) ||
1898 (geo->a[i].flags & IEEE80211_CH_RADAR_DETECT))
1899 ? "" : ", IBSS",
1900 geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1901 "passive only" : "active/passive");
1902 }
1903
1904 return len;
1905}
1906
1907static DEVICE_ATTR(channels, S_IRUSR, show_channels, NULL);
1908
James Ketrenosea2b26e2005-08-24 21:25:16 -05001909static void notify_wx_assoc_event(struct ipw_priv *priv)
1910{
1911 union iwreq_data wrqu;
1912 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1913 if (priv->status & STATUS_ASSOCIATED)
1914 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1915 else
1916 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1917 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1918}
1919
James Ketrenos43f66a62005-03-25 12:31:53 -06001920static void ipw_irq_tasklet(struct ipw_priv *priv)
1921{
1922 u32 inta, inta_mask, handled = 0;
1923 unsigned long flags;
1924 int rc = 0;
1925
Zhu Yi89c318e2006-06-08 22:19:49 -07001926 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001927
James Ketrenosb095c382005-08-24 22:04:42 -05001928 inta = ipw_read32(priv, IPW_INTA_RW);
1929 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1930 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001931
1932 /* Add any cached INTA values that need to be handled */
1933 inta |= priv->isr_inta;
1934
Zhu Yi89c318e2006-06-08 22:19:49 -07001935 spin_unlock_irqrestore(&priv->irq_lock, flags);
1936
1937 spin_lock_irqsave(&priv->lock, flags);
1938
James Ketrenos43f66a62005-03-25 12:31:53 -06001939 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001940 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001941 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001942 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001943 }
1944
James Ketrenosb095c382005-08-24 22:04:42 -05001945 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001946 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001947 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001948 priv->status &= ~STATUS_HCMD_ACTIVE;
1949 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001950 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001951 }
1952
James Ketrenosb095c382005-08-24 22:04:42 -05001953 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001954 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001955 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001956 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001957 }
1958
James Ketrenosb095c382005-08-24 22:04:42 -05001959 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001960 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001961 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001962 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001963 }
1964
James Ketrenosb095c382005-08-24 22:04:42 -05001965 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001966 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001967 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001968 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001969 }
1970
James Ketrenosb095c382005-08-24 22:04:42 -05001971 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001972 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001973 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001974 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001975 }
1976
James Ketrenosb095c382005-08-24 22:04:42 -05001977 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001978 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001979 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001980 }
1981
James Ketrenosb095c382005-08-24 22:04:42 -05001982 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001983 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001984 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06001985 }
1986
James Ketrenosb095c382005-08-24 22:04:42 -05001987 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001988 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001989 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001990 }
1991
James Ketrenosb095c382005-08-24 22:04:42 -05001992 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001993 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001994 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001995 }
1996
James Ketrenosb095c382005-08-24 22:04:42 -05001997 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001998 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001999 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002000 }
2001
James Ketrenosb095c382005-08-24 22:04:42 -05002002 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002003 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
2004 priv->status |= STATUS_RF_KILL_HW;
2005 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05002006 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06002007 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -04002008 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -05002009 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06002010 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05002011 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002012 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002013
James Ketrenosb095c382005-08-24 22:04:42 -05002014 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002015 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002016 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002017 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002018 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
2019 struct ipw_fw_error *error =
2020 ipw_alloc_error_log(priv);
2021 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07002022 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002023 }
James Ketrenosb39860c2005-08-12 09:36:32 -05002024 } else {
2025 priv->error = ipw_alloc_error_log(priv);
2026 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002027 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002028 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002029 IPW_DEBUG_FW("Error allocating sysfs 'error' "
2030 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002031 if (ipw_debug_level & IPW_DL_FW_ERRORS)
2032 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002033 }
2034
James Ketrenosb095c382005-08-24 22:04:42 -05002035 /* XXX: If hardware encryption is for WPA/WPA2,
2036 * we have to notify the supplicant. */
2037 if (priv->ieee->sec.encrypt) {
2038 priv->status &= ~STATUS_ASSOCIATED;
2039 notify_wx_assoc_event(priv);
2040 }
2041
2042 /* Keep the restart process from trying to send host
2043 * commands by clearing the INIT status bit */
2044 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05002045
2046 /* Cancel currently queued command. */
2047 priv->status &= ~STATUS_HCMD_ACTIVE;
2048 wake_up_interruptible(&priv->wait_command_queue);
2049
James Ketrenos43f66a62005-03-25 12:31:53 -06002050 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05002051 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002052 }
2053
James Ketrenosb095c382005-08-24 22:04:42 -05002054 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002055 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002056 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002057 }
2058
2059 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002060 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002061 }
2062
Zhu Yi89c318e2006-06-08 22:19:49 -07002063 spin_unlock_irqrestore(&priv->lock, flags);
2064
James Ketrenos43f66a62005-03-25 12:31:53 -06002065 /* enable all interrupts */
2066 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002067}
Jeff Garzikbf794512005-07-31 13:07:26 -04002068
James Ketrenos43f66a62005-03-25 12:31:53 -06002069#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2070static char *get_cmd_string(u8 cmd)
2071{
2072 switch (cmd) {
2073 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002074 IPW_CMD(POWER_DOWN);
2075 IPW_CMD(SYSTEM_CONFIG);
2076 IPW_CMD(MULTICAST_ADDRESS);
2077 IPW_CMD(SSID);
2078 IPW_CMD(ADAPTER_ADDRESS);
2079 IPW_CMD(PORT_TYPE);
2080 IPW_CMD(RTS_THRESHOLD);
2081 IPW_CMD(FRAG_THRESHOLD);
2082 IPW_CMD(POWER_MODE);
2083 IPW_CMD(WEP_KEY);
2084 IPW_CMD(TGI_TX_KEY);
2085 IPW_CMD(SCAN_REQUEST);
2086 IPW_CMD(SCAN_REQUEST_EXT);
2087 IPW_CMD(ASSOCIATE);
2088 IPW_CMD(SUPPORTED_RATES);
2089 IPW_CMD(SCAN_ABORT);
2090 IPW_CMD(TX_FLUSH);
2091 IPW_CMD(QOS_PARAMETERS);
2092 IPW_CMD(DINO_CONFIG);
2093 IPW_CMD(RSN_CAPABILITIES);
2094 IPW_CMD(RX_KEY);
2095 IPW_CMD(CARD_DISABLE);
2096 IPW_CMD(SEED_NUMBER);
2097 IPW_CMD(TX_POWER);
2098 IPW_CMD(COUNTRY_INFO);
2099 IPW_CMD(AIRONET_INFO);
2100 IPW_CMD(AP_TX_POWER);
2101 IPW_CMD(CCKM_INFO);
2102 IPW_CMD(CCX_VER_INFO);
2103 IPW_CMD(SET_CALIBRATION);
2104 IPW_CMD(SENSITIVITY_CALIB);
2105 IPW_CMD(RETRY_LIMIT);
2106 IPW_CMD(IPW_PRE_POWER_DOWN);
2107 IPW_CMD(VAP_BEACON_TEMPLATE);
2108 IPW_CMD(VAP_DTIM_PERIOD);
2109 IPW_CMD(EXT_SUPPORTED_RATES);
2110 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2111 IPW_CMD(VAP_QUIET_INTERVALS);
2112 IPW_CMD(VAP_CHANNEL_SWITCH);
2113 IPW_CMD(VAP_MANDATORY_CHANNELS);
2114 IPW_CMD(VAP_CELL_PWR_LIMIT);
2115 IPW_CMD(VAP_CF_PARAM_SET);
2116 IPW_CMD(VAP_SET_BEACONING_STATE);
2117 IPW_CMD(MEASUREMENT);
2118 IPW_CMD(POWER_CAPABILITY);
2119 IPW_CMD(SUPPORTED_CHANNELS);
2120 IPW_CMD(TPC_REPORT);
2121 IPW_CMD(WME_INFO);
2122 IPW_CMD(PRODUCTION_COMMAND);
2123 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002124 return "UNKNOWN";
2125 }
2126}
James Ketrenos43f66a62005-03-25 12:31:53 -06002127
2128#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002129
2130static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002131{
2132 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002133 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002134
James Ketrenosa613bff2005-08-24 21:43:11 -05002135 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002136 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002137 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2138 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002139 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002140 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002141 }
2142
2143 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002144
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002145 if (priv->cmdlog) {
2146 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2147 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2148 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2149 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2150 cmd->len);
2151 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2152 }
2153
James Ketrenosb095c382005-08-24 22:04:42 -05002154 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2155 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2156 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002157
2158#ifndef DEBUG_CMD_WEP_KEY
2159 if (cmd->cmd == IPW_CMD_WEP_KEY)
2160 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2161 else
2162#endif
2163 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2164
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002165 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002166 if (rc) {
2167 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002168 IPW_ERROR("Failed to send %s: Reason %d\n",
2169 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002170 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002171 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002172 }
2173 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002174
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002175 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2176 !(priv->
2177 status & STATUS_HCMD_ACTIVE),
2178 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002179 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002180 spin_lock_irqsave(&priv->lock, flags);
2181 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002182 IPW_ERROR("Failed to send %s: Command timed out.\n",
2183 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002184 priv->status &= ~STATUS_HCMD_ACTIVE;
2185 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002186 rc = -EIO;
2187 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002188 }
2189 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002190 } else
2191 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002192
James Ketrenosb095c382005-08-24 22:04:42 -05002193 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002194 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2195 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002196 rc = -EIO;
2197 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002198 }
2199
Zhu Yi2638bc32006-01-24 16:37:52 +08002200 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002201 if (priv->cmdlog) {
2202 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2203 priv->cmdlog_pos %= priv->cmdlog_len;
2204 }
2205 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002206}
2207
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002208static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002209{
2210 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002211 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002212 };
2213
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002214 return __ipw_send_cmd(priv, &cmd);
2215}
2216
2217static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2218 void *data)
2219{
2220 struct host_cmd cmd = {
2221 .cmd = command,
2222 .len = len,
2223 .param = data,
2224 };
2225
2226 return __ipw_send_cmd(priv, &cmd);
2227}
2228
2229static int ipw_send_host_complete(struct ipw_priv *priv)
2230{
James Ketrenos43f66a62005-03-25 12:31:53 -06002231 if (!priv) {
2232 IPW_ERROR("Invalid args\n");
2233 return -1;
2234 }
2235
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002236 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002237}
2238
Zhu Yid685b8c2006-04-13 17:20:27 +08002239static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002240{
Zhu Yid685b8c2006-04-13 17:20:27 +08002241 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2242 sizeof(priv->sys_config),
2243 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002244}
2245
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002246static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002247{
James Ketrenos43f66a62005-03-25 12:31:53 -06002248 if (!priv || !ssid) {
2249 IPW_ERROR("Invalid args\n");
2250 return -1;
2251 }
2252
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002253 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002254 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002255}
2256
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002257static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002258{
James Ketrenos43f66a62005-03-25 12:31:53 -06002259 if (!priv || !mac) {
2260 IPW_ERROR("Invalid args\n");
2261 return -1;
2262 }
2263
Joe Perches0795af52007-10-03 17:59:30 -07002264 IPW_DEBUG_INFO("%s: Setting MAC to %s\n",
2265 priv->net_dev->name, print_mac(mac, mac));
James Ketrenos43f66a62005-03-25 12:31:53 -06002266
Zhu Yi2638bc32006-01-24 16:37:52 +08002267 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002268}
2269
James Ketrenosa613bff2005-08-24 21:43:11 -05002270/*
2271 * NOTE: This must be executed from our workqueue as it results in udelay
2272 * being called which may corrupt the keyboard if executed on default
2273 * workqueue
2274 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002275static void ipw_adapter_restart(void *adapter)
2276{
2277 struct ipw_priv *priv = adapter;
2278
2279 if (priv->status & STATUS_RF_KILL_MASK)
2280 return;
2281
2282 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002283
2284 if (priv->assoc_network &&
2285 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2286 ipw_remove_current_network(priv);
2287
James Ketrenos43f66a62005-03-25 12:31:53 -06002288 if (ipw_up(priv)) {
2289 IPW_ERROR("Failed to up device\n");
2290 return;
2291 }
2292}
2293
David Howellsc4028952006-11-22 14:57:56 +00002294static void ipw_bg_adapter_restart(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002295{
David Howellsc4028952006-11-22 14:57:56 +00002296 struct ipw_priv *priv =
2297 container_of(work, struct ipw_priv, adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08002298 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002299 ipw_adapter_restart(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002300 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002301}
2302
James Ketrenos43f66a62005-03-25 12:31:53 -06002303#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2304
2305static void ipw_scan_check(void *data)
2306{
2307 struct ipw_priv *priv = data;
2308 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2309 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002310 "adapter after (%dms).\n",
2311 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002312 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002313 }
2314}
2315
David Howellsc4028952006-11-22 14:57:56 +00002316static void ipw_bg_scan_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002317{
David Howellsc4028952006-11-22 14:57:56 +00002318 struct ipw_priv *priv =
2319 container_of(work, struct ipw_priv, scan_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08002320 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002321 ipw_scan_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002322 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002323}
2324
James Ketrenos43f66a62005-03-25 12:31:53 -06002325static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2326 struct ipw_scan_request_ext *request)
2327{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002328 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002329 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002330}
2331
2332static int ipw_send_scan_abort(struct ipw_priv *priv)
2333{
James Ketrenos43f66a62005-03-25 12:31:53 -06002334 if (!priv) {
2335 IPW_ERROR("Invalid args\n");
2336 return -1;
2337 }
2338
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002339 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002340}
2341
2342static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2343{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002344 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002345 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002346 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002347
2348 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002349 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002350}
2351
2352static int ipw_send_associate(struct ipw_priv *priv,
2353 struct ipw_associate *associate)
2354{
James Ketrenosa613bff2005-08-24 21:43:11 -05002355 struct ipw_associate tmp_associate;
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002356
2357 if (!priv || !associate) {
2358 IPW_ERROR("Invalid args\n");
2359 return -1;
2360 }
2361
James Ketrenosa613bff2005-08-24 21:43:11 -05002362 memcpy(&tmp_associate, associate, sizeof(*associate));
2363 tmp_associate.policy_support =
2364 cpu_to_le16(tmp_associate.policy_support);
2365 tmp_associate.assoc_tsf_msw = cpu_to_le32(tmp_associate.assoc_tsf_msw);
2366 tmp_associate.assoc_tsf_lsw = cpu_to_le32(tmp_associate.assoc_tsf_lsw);
2367 tmp_associate.capability = cpu_to_le16(tmp_associate.capability);
2368 tmp_associate.listen_interval =
2369 cpu_to_le16(tmp_associate.listen_interval);
2370 tmp_associate.beacon_interval =
2371 cpu_to_le16(tmp_associate.beacon_interval);
2372 tmp_associate.atim_window = cpu_to_le16(tmp_associate.atim_window);
2373
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002374 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(tmp_associate),
Zhu Yi2638bc32006-01-24 16:37:52 +08002375 &tmp_associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002376}
2377
2378static int ipw_send_supported_rates(struct ipw_priv *priv,
2379 struct ipw_supported_rates *rates)
2380{
James Ketrenos43f66a62005-03-25 12:31:53 -06002381 if (!priv || !rates) {
2382 IPW_ERROR("Invalid args\n");
2383 return -1;
2384 }
2385
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002386 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002387 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002388}
2389
2390static int ipw_set_random_seed(struct ipw_priv *priv)
2391{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002392 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002393
2394 if (!priv) {
2395 IPW_ERROR("Invalid args\n");
2396 return -1;
2397 }
2398
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002399 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002400
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002401 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002402}
2403
James Ketrenos43f66a62005-03-25 12:31:53 -06002404static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2405{
James Ketrenos43f66a62005-03-25 12:31:53 -06002406 if (!priv) {
2407 IPW_ERROR("Invalid args\n");
2408 return -1;
2409 }
2410
Zhu Yi851ca262006-08-21 11:37:58 +08002411 phy_off = cpu_to_le32(phy_off);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002412 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(phy_off),
Zhu Yi2638bc32006-01-24 16:37:52 +08002413 &phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002414}
James Ketrenos43f66a62005-03-25 12:31:53 -06002415
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002416static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002417{
James Ketrenos43f66a62005-03-25 12:31:53 -06002418 if (!priv || !power) {
2419 IPW_ERROR("Invalid args\n");
2420 return -1;
2421 }
2422
Zhu Yi2638bc32006-01-24 16:37:52 +08002423 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002424}
James Ketrenos43f66a62005-03-25 12:31:53 -06002425
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002426static int ipw_set_tx_power(struct ipw_priv *priv)
2427{
Larry Finger1867b112006-02-28 09:48:28 -06002428 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002429 struct ipw_tx_power tx_power;
2430 s8 max_power;
2431 int i;
2432
2433 memset(&tx_power, 0, sizeof(tx_power));
2434
2435 /* configure device for 'G' band */
2436 tx_power.ieee_mode = IPW_G_MODE;
2437 tx_power.num_channels = geo->bg_channels;
2438 for (i = 0; i < geo->bg_channels; i++) {
2439 max_power = geo->bg[i].max_power;
2440 tx_power.channels_tx_power[i].channel_number =
2441 geo->bg[i].channel;
2442 tx_power.channels_tx_power[i].tx_power = max_power ?
2443 min(max_power, priv->tx_power) : priv->tx_power;
2444 }
2445 if (ipw_send_tx_power(priv, &tx_power))
2446 return -EIO;
2447
2448 /* configure device to also handle 'B' band */
2449 tx_power.ieee_mode = IPW_B_MODE;
2450 if (ipw_send_tx_power(priv, &tx_power))
2451 return -EIO;
2452
2453 /* configure device to also handle 'A' band */
2454 if (priv->ieee->abg_true) {
2455 tx_power.ieee_mode = IPW_A_MODE;
2456 tx_power.num_channels = geo->a_channels;
2457 for (i = 0; i < tx_power.num_channels; i++) {
2458 max_power = geo->a[i].max_power;
2459 tx_power.channels_tx_power[i].channel_number =
2460 geo->a[i].channel;
2461 tx_power.channels_tx_power[i].tx_power = max_power ?
2462 min(max_power, priv->tx_power) : priv->tx_power;
2463 }
2464 if (ipw_send_tx_power(priv, &tx_power))
2465 return -EIO;
2466 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002467 return 0;
2468}
2469
2470static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2471{
2472 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002473 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002474 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002475
2476 if (!priv) {
2477 IPW_ERROR("Invalid args\n");
2478 return -1;
2479 }
2480
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002481 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2482 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002483}
2484
2485static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2486{
2487 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002488 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002489 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002490
2491 if (!priv) {
2492 IPW_ERROR("Invalid args\n");
2493 return -1;
2494 }
2495
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002496 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2497 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002498}
2499
2500static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2501{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002502 u32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002503
2504 if (!priv) {
2505 IPW_ERROR("Invalid args\n");
2506 return -1;
2507 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002508
James Ketrenos43f66a62005-03-25 12:31:53 -06002509 /* If on battery, set to 3, if AC set to CAM, else user
2510 * level */
2511 switch (mode) {
2512 case IPW_POWER_BATTERY:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002513 param = IPW_POWER_INDEX_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06002514 break;
2515 case IPW_POWER_AC:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002516 param = IPW_POWER_MODE_CAM;
James Ketrenos43f66a62005-03-25 12:31:53 -06002517 break;
2518 default:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002519 param = mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06002520 break;
2521 }
2522
Zhu Yi4e157f02007-07-12 16:09:32 +08002523 param = cpu_to_le32(param);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002524 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002525 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002526}
2527
James Ketrenosafbf30a2005-08-25 00:05:33 -05002528static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2529{
2530 struct ipw_retry_limit retry_limit = {
2531 .short_retry_limit = slimit,
2532 .long_retry_limit = llimit
2533 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002534
2535 if (!priv) {
2536 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002537 return -1;
2538 }
2539
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002540 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002541 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002542}
2543
2544/*
2545 * The IPW device contains a Microwire compatible EEPROM that stores
2546 * various data like the MAC address. Usually the firmware has exclusive
2547 * access to the eeprom, but during device initialization (before the
2548 * device driver has sent the HostComplete command to the firmware) the
2549 * device driver has read access to the EEPROM by way of indirect addressing
2550 * through a couple of memory mapped registers.
2551 *
2552 * The following is a simplified implementation for pulling data out of the
2553 * the eeprom, along with some helper functions to find information in
2554 * the per device private data's copy of the eeprom.
2555 *
2556 * NOTE: To better understand how these functions work (i.e what is a chip
2557 * select and why do have to keep driving the eeprom clock?), read
2558 * just about any data sheet for a Microwire compatible EEPROM.
2559 */
2560
2561/* write a 32 bit value into the indirect accessor register */
2562static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2563{
2564 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002565
James Ketrenos43f66a62005-03-25 12:31:53 -06002566 /* the eeprom requires some time to complete the operation */
2567 udelay(p->eeprom_delay);
2568
2569 return;
2570}
2571
2572/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002573static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002574{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002575 eeprom_write_reg(priv, 0);
2576 eeprom_write_reg(priv, EEPROM_BIT_CS);
2577 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2578 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002579}
2580
2581/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002582static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002583{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002584 eeprom_write_reg(priv, EEPROM_BIT_CS);
2585 eeprom_write_reg(priv, 0);
2586 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002587}
2588
2589/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002590static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002591{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002592 int d = (bit ? EEPROM_BIT_DI : 0);
2593 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2594 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002595}
2596
2597/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002598static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002599{
2600 int i;
2601
2602 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002603 eeprom_write_bit(priv, 1);
2604 eeprom_write_bit(priv, op & 2);
2605 eeprom_write_bit(priv, op & 1);
2606 for (i = 7; i >= 0; i--) {
2607 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002608 }
2609}
2610
2611/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002612static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002613{
2614 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002615 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002616
James Ketrenos43f66a62005-03-25 12:31:53 -06002617 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002618 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002619
2620 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002621 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002622
2623 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002624 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002625 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002626 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2627 eeprom_write_reg(priv, EEPROM_BIT_CS);
2628 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2629 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002630 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002631
James Ketrenos43f66a62005-03-25 12:31:53 -06002632 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002633 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002634 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002635
James Ketrenos43f66a62005-03-25 12:31:53 -06002636 return r;
2637}
2638
2639/* helper function for pulling the mac address out of the private */
2640/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002641static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002642{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002643 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002644}
2645
2646/*
2647 * Either the device driver (i.e. the host) or the firmware can
2648 * load eeprom data into the designated region in SRAM. If neither
2649 * happens then the FW will shutdown with a fatal error.
2650 *
2651 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2652 * bit needs region of shared SRAM needs to be non-zero.
2653 */
2654static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2655{
2656 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002657 u16 *eeprom = (u16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002658
James Ketrenos43f66a62005-03-25 12:31:53 -06002659 IPW_DEBUG_TRACE(">>\n");
2660
2661 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002662 for (i = 0; i < 128; i++)
James Ketrenosa613bff2005-08-24 21:43:11 -05002663 eeprom[i] = le16_to_cpu(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002664
Jeff Garzikbf794512005-07-31 13:07:26 -04002665 /*
2666 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002667 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002668 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002669 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002670 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002671 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2672
2673 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002674 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002675 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002676
2677 /* Do not load eeprom data on fatal error or suspend */
2678 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2679 } else {
2680 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2681
2682 /* Load eeprom data on fatal error or suspend */
2683 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2684 }
2685
2686 IPW_DEBUG_TRACE("<<\n");
2687}
2688
Arjan van de Ven858119e2006-01-14 13:20:43 -08002689static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002690{
2691 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002692 if (!count)
2693 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002694 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002695 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002696 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002697}
2698
2699static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2700{
James Ketrenosb095c382005-08-24 22:04:42 -05002701 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002702 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002703 sizeof(struct command_block));
2704}
2705
2706static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002707{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002708
2709 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002710
James Ketrenos43f66a62005-03-25 12:31:53 -06002711 /* Start the dma */
2712 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002713
James Ketrenos43f66a62005-03-25 12:31:53 -06002714 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002715 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002716
2717 IPW_DEBUG_FW("<< : \n");
2718 return 0;
2719}
2720
2721static void ipw_fw_dma_abort(struct ipw_priv *priv)
2722{
2723 u32 control = 0;
2724
2725 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002726
Pavel Machek67fd6b42006-07-11 15:34:05 +02002727 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002728 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002729 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002730 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002731
James Ketrenos43f66a62005-03-25 12:31:53 -06002732 IPW_DEBUG_FW("<< \n");
2733}
2734
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002735static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2736 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002737{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002738 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002739 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002740 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002741 IPW_DEBUG_FW(">> :\n");
2742
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002743 ipw_write_indirect(priv, address, (u8 *) cb,
2744 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002745
2746 IPW_DEBUG_FW("<< :\n");
2747 return 0;
2748
2749}
2750
2751static int ipw_fw_dma_kick(struct ipw_priv *priv)
2752{
2753 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002754 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002755
2756 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002757
James Ketrenos43f66a62005-03-25 12:31:53 -06002758 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002759 ipw_fw_dma_write_command_block(priv, index,
2760 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002761
2762 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002763 ipw_clear_bit(priv, IPW_RESET_REG,
2764 IPW_RESET_REG_MASTER_DISABLED |
2765 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002766
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002767 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002768 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002769 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002770
2771 IPW_DEBUG_FW("<< :\n");
2772 return 0;
2773}
2774
2775static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2776{
2777 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002778 u32 register_value = 0;
2779 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002780
2781 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002782 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002783 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002784
2785 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002786 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2787 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002788
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002789 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002790 cb_fields_address = address;
2791 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002792 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002793
2794 cb_fields_address += sizeof(u32);
2795 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002796 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002797
2798 cb_fields_address += sizeof(u32);
2799 register_value = ipw_read_reg32(priv, cb_fields_address);
2800 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2801 register_value);
2802
2803 cb_fields_address += sizeof(u32);
2804 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002805 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002806
2807 IPW_DEBUG_FW(">> :\n");
2808}
2809
2810static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2811{
2812 u32 current_cb_address = 0;
2813 u32 current_cb_index = 0;
2814
2815 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002816 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002817
James Ketrenosb095c382005-08-24 22:04:42 -05002818 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002819 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002820
James Ketrenos43f66a62005-03-25 12:31:53 -06002821 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002822 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002823
2824 IPW_DEBUG_FW(">> :\n");
2825 return current_cb_index;
2826
2827}
2828
2829static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2830 u32 src_address,
2831 u32 dest_address,
2832 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002833 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002834{
2835
Jeff Garzikbf794512005-07-31 13:07:26 -04002836 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002837 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2838 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002839 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002840 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002841
2842 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2843 src_address, dest_address, length);
2844
2845 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2846 return -1;
2847
2848 last_cb_element = priv->sram_desc.last_cb_index;
2849 cb = &priv->sram_desc.cb_list[last_cb_element];
2850 priv->sram_desc.last_cb_index++;
2851
2852 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002853 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002854 control |= CB_INT_ENABLED;
2855
2856 if (is_last)
2857 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002858
James Ketrenos43f66a62005-03-25 12:31:53 -06002859 control |= length;
2860
2861 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002862 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002863
2864 /* Copy the Source and Destination addresses */
2865 cb->dest_addr = dest_address;
2866 cb->source_addr = src_address;
2867
2868 /* Copy the Control Word last */
2869 cb->control = control;
2870
2871 return 0;
2872}
2873
2874static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002875 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002876{
2877 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002878 u32 src_offset = 0;
2879 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002880 int status = 0;
2881 IPW_DEBUG_FW(">> \n");
2882 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2883 src_phys, dest_address, length);
2884 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002885 status = ipw_fw_dma_add_command_block(priv,
2886 src_phys + src_offset,
2887 dest_address +
2888 dest_offset,
2889 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002890 if (status) {
2891 IPW_DEBUG_FW_INFO(": Failed\n");
2892 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002893 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002894 IPW_DEBUG_FW_INFO(": Added new cb\n");
2895
2896 src_offset += CB_MAX_LENGTH;
2897 dest_offset += CB_MAX_LENGTH;
2898 bytes_left -= CB_MAX_LENGTH;
2899 }
2900
2901 /* add the buffer tail */
2902 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002903 status =
2904 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2905 dest_address + dest_offset,
2906 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002907 if (status) {
2908 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2909 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002910 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002911 IPW_DEBUG_FW_INFO
2912 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002913 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002914
James Ketrenos43f66a62005-03-25 12:31:53 -06002915 IPW_DEBUG_FW("<< \n");
2916 return 0;
2917}
2918
2919static int ipw_fw_dma_wait(struct ipw_priv *priv)
2920{
Zhu Yi397ae122006-01-24 16:37:22 +08002921 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002922 u32 watchdog = 0;
2923
2924 IPW_DEBUG_FW(">> : \n");
2925
2926 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002927 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002928 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002929
2930 while (current_index < priv->sram_desc.last_cb_index) {
2931 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002932 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002933 current_index = ipw_fw_dma_command_block_index(priv);
2934
Zhu Yi397ae122006-01-24 16:37:22 +08002935 if (previous_index < current_index) {
2936 watchdog = 0;
2937 continue;
2938 }
2939 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002940 IPW_DEBUG_FW_INFO("Timeout\n");
2941 ipw_fw_dma_dump_command_block(priv);
2942 ipw_fw_dma_abort(priv);
2943 return -1;
2944 }
2945 }
2946
2947 ipw_fw_dma_abort(priv);
2948
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002949 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002950 ipw_set_bit(priv, IPW_RESET_REG,
2951 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002952
2953 IPW_DEBUG_FW("<< dmaWaitSync \n");
2954 return 0;
2955}
2956
Jeff Garzikbf794512005-07-31 13:07:26 -04002957static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002958{
2959 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002960 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002961 unsigned long flags;
2962
2963 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002964 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2965 network = list_entry(element, struct ieee80211_network, list);
2966 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2967 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002968 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002969 &priv->ieee->network_free_list);
2970 }
2971 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002972 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002973}
2974
2975/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002976 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002977 * Reads debug register from domain0.
2978 * If card is present, pre-defined value should
2979 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002980 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002981 * @param priv
2982 * @return 1 if card is present, 0 otherwise
2983 */
2984static inline int ipw_alive(struct ipw_priv *priv)
2985{
2986 return ipw_read32(priv, 0x90) == 0xd55555d5;
2987}
2988
Zhu Yic7b6a672006-01-24 16:37:05 +08002989/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002990static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002991 int timeout)
2992{
2993 int i = 0;
2994
2995 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002996 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002997 return i;
2998 mdelay(10);
2999 i += 10;
3000 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04003001
James Ketrenos43f66a62005-03-25 12:31:53 -06003002 return -ETIME;
3003}
3004
Jeff Garzikbf794512005-07-31 13:07:26 -04003005/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06003006 * the ipw hardware. It assumes the buffer has all the bits for the
3007 * image and the caller is handling the memory allocation and clean up.
3008 */
3009
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003010static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06003011{
3012 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003013
James Ketrenos43f66a62005-03-25 12:31:53 -06003014 IPW_DEBUG_TRACE(">> \n");
3015 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05003016 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003017
Zhu Yic7b6a672006-01-24 16:37:05 +08003018 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05003019 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3020 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06003021 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003022 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003023 return -1;
3024 }
3025
3026 IPW_DEBUG_INFO("stop master %dms\n", rc);
3027
3028 return rc;
3029}
3030
3031static void ipw_arc_release(struct ipw_priv *priv)
3032{
3033 IPW_DEBUG_TRACE(">> \n");
3034 mdelay(5);
3035
James Ketrenosb095c382005-08-24 22:04:42 -05003036 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003037
3038 /* no one knows timing, for safety add some delay */
3039 mdelay(5);
3040}
3041
James Ketrenos43f66a62005-03-25 12:31:53 -06003042struct fw_chunk {
3043 u32 address;
3044 u32 length;
3045};
3046
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003047static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003048{
3049 int rc = 0, i, addr;
3050 u8 cr = 0;
3051 u16 *image;
3052
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003053 image = (u16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04003054
James Ketrenos43f66a62005-03-25 12:31:53 -06003055 IPW_DEBUG_TRACE(">> \n");
3056
3057 rc = ipw_stop_master(priv);
3058
3059 if (rc < 0)
3060 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003061
James Ketrenosb095c382005-08-24 22:04:42 -05003062 for (addr = IPW_SHARED_LOWER_BOUND;
3063 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003064 ipw_write32(priv, addr, 0);
3065 }
3066
3067 /* no ucode (yet) */
3068 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3069 /* destroy DMA queues */
3070 /* reset sequence */
3071
James Ketrenosb095c382005-08-24 22:04:42 -05003072 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003073 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003074 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003075 mdelay(1);
3076
3077 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003078 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003079 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003080
James Ketrenosb095c382005-08-24 22:04:42 -05003081 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003082 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003083
James Ketrenos43f66a62005-03-25 12:31:53 -06003084 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003085 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3086 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003087 mdelay(1);
3088
3089 /* write ucode */
3090 /**
3091 * @bug
3092 * Do NOT set indirect address register once and then
3093 * store data to indirect data register in the loop.
3094 * It seems very reasonable, but in this case DINO do not
3095 * accept ucode. It is essential to set address each time.
3096 */
3097 /* load new ipw uCode */
3098 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003099 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
James Ketrenosa613bff2005-08-24 21:43:11 -05003100 cpu_to_le16(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003101
James Ketrenos43f66a62005-03-25 12:31:53 -06003102 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003103 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3104 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003105
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003106 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003107
3108 /* wait for alive response */
3109 for (i = 0; i < 100; i++) {
3110 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003111 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003112 if (cr & DINO_RXFIFO_DATA)
3113 break;
3114 mdelay(1);
3115 }
3116
3117 if (cr & DINO_RXFIFO_DATA) {
3118 /* alive_command_responce size is NOT multiple of 4 */
3119 u32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003120
3121 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003122 response_buffer[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -05003123 le32_to_cpu(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003124 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003125 memcpy(&priv->dino_alive, response_buffer,
3126 sizeof(priv->dino_alive));
3127 if (priv->dino_alive.alive_command == 1
3128 && priv->dino_alive.ucode_valid == 1) {
3129 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003130 IPW_DEBUG_INFO
3131 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3132 "of %02d/%02d/%02d %02d:%02d\n",
3133 priv->dino_alive.software_revision,
3134 priv->dino_alive.software_revision,
3135 priv->dino_alive.device_identifier,
3136 priv->dino_alive.device_identifier,
3137 priv->dino_alive.time_stamp[0],
3138 priv->dino_alive.time_stamp[1],
3139 priv->dino_alive.time_stamp[2],
3140 priv->dino_alive.time_stamp[3],
3141 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003142 } else {
3143 IPW_DEBUG_INFO("Microcode is not alive\n");
3144 rc = -EINVAL;
3145 }
3146 } else {
3147 IPW_DEBUG_INFO("No alive response from DINO\n");
3148 rc = -ETIME;
3149 }
3150
3151 /* disable DINO, otherwise for some reason
3152 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003153 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003154
James Ketrenos43f66a62005-03-25 12:31:53 -06003155 return rc;
3156}
3157
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003158static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003159{
3160 int rc = -1;
3161 int offset = 0;
3162 struct fw_chunk *chunk;
3163 dma_addr_t shared_phys;
3164 u8 *shared_virt;
3165
3166 IPW_DEBUG_TRACE("<< : \n");
3167 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3168
3169 if (!shared_virt)
3170 return -ENOMEM;
3171
3172 memmove(shared_virt, data, len);
3173
3174 /* Start the Dma */
3175 rc = ipw_fw_dma_enable(priv);
3176
3177 if (priv->sram_desc.last_cb_index > 0) {
3178 /* the DMA is already ready this would be a bug. */
3179 BUG();
3180 goto out;
3181 }
3182
3183 do {
3184 chunk = (struct fw_chunk *)(data + offset);
3185 offset += sizeof(struct fw_chunk);
3186 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003187 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003188 * offeset*/
3189 /* Dma loading */
3190 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003191 le32_to_cpu(chunk->address),
3192 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003193 if (rc) {
3194 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3195 goto out;
3196 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003197
James Ketrenosa613bff2005-08-24 21:43:11 -05003198 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003199 } while (offset < len);
3200
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003201 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003202 rc = ipw_fw_dma_kick(priv);
3203 if (rc) {
3204 IPW_ERROR("dmaKick Failed\n");
3205 goto out;
3206 }
3207
3208 rc = ipw_fw_dma_wait(priv);
3209 if (rc) {
3210 IPW_ERROR("dmaWaitSync Failed\n");
3211 goto out;
3212 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003213 out:
3214 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003215 return rc;
3216}
3217
3218/* stop nic */
3219static int ipw_stop_nic(struct ipw_priv *priv)
3220{
3221 int rc = 0;
3222
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003223 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003224 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003225
James Ketrenosb095c382005-08-24 22:04:42 -05003226 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3227 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003228 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003229 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003230 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003231 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003232
James Ketrenosb095c382005-08-24 22:04:42 -05003233 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003234
James Ketrenos43f66a62005-03-25 12:31:53 -06003235 return rc;
3236}
3237
3238static void ipw_start_nic(struct ipw_priv *priv)
3239{
3240 IPW_DEBUG_TRACE(">>\n");
3241
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003242 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003243 ipw_clear_bit(priv, IPW_RESET_REG,
3244 IPW_RESET_REG_MASTER_DISABLED |
3245 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003246 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003247
James Ketrenos43f66a62005-03-25 12:31:53 -06003248 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003249 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3250 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003251
3252 IPW_DEBUG_TRACE("<<\n");
3253}
Jeff Garzikbf794512005-07-31 13:07:26 -04003254
James Ketrenos43f66a62005-03-25 12:31:53 -06003255static int ipw_init_nic(struct ipw_priv *priv)
3256{
3257 int rc;
3258
3259 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003260 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003261 /*prvHwInitNic */
3262 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003263 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003264
3265 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003266 ipw_write32(priv, IPW_READ_INT_REGISTER,
3267 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003268
3269 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003270 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3271 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003272 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003273 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3274
3275 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003276 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003277
3278 udelay(10);
3279
3280 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003281 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003282
3283 IPW_DEBUG_TRACE(">>\n");
3284 return 0;
3285}
3286
Jeff Garzikbf794512005-07-31 13:07:26 -04003287/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003288 * Probe is an ok place to call this from.
3289 */
3290static int ipw_reset_nic(struct ipw_priv *priv)
3291{
3292 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003293 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003294
3295 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003296
James Ketrenos43f66a62005-03-25 12:31:53 -06003297 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003298
James Ketrenosa613bff2005-08-24 21:43:11 -05003299 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003300 /* Clear the 'host command active' bit... */
3301 priv->status &= ~STATUS_HCMD_ACTIVE;
3302 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003303 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3304 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003305 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003306
3307 IPW_DEBUG_TRACE("<<\n");
3308 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003309}
James Ketrenos43f66a62005-03-25 12:31:53 -06003310
James Ketrenos9006ea72006-03-08 03:22:28 +08003311
3312struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003313 __le32 ver;
3314 __le32 boot_size;
3315 __le32 ucode_size;
3316 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003317 u8 data[0];
3318};
3319
Jeff Garzikbf794512005-07-31 13:07:26 -04003320static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003321 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003322{
James Ketrenos9006ea72006-03-08 03:22:28 +08003323 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003324 int rc;
3325
3326 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003327 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003328 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003329 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003330 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003331 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003332
James Ketrenos9006ea72006-03-08 03:22:28 +08003333 if ((*raw)->size < sizeof(*fw)) {
3334 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003335 return -EINVAL;
3336 }
3337
James Ketrenos9006ea72006-03-08 03:22:28 +08003338 fw = (void *)(*raw)->data;
3339
Zhu Yi0070f8c2006-04-13 17:20:12 +08003340 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3341 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003342 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3343 name, (*raw)->size);
3344 return -EINVAL;
3345 }
3346
3347 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003348 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003349 le32_to_cpu(fw->ver) >> 16,
3350 le32_to_cpu(fw->ver) & 0xff,
3351 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003352 return 0;
3353}
3354
James Ketrenosb095c382005-08-24 22:04:42 -05003355#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003356
Arjan van de Ven858119e2006-01-14 13:20:43 -08003357static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003358 struct ipw_rx_queue *rxq)
3359{
3360 unsigned long flags;
3361 int i;
3362
3363 spin_lock_irqsave(&rxq->lock, flags);
3364
3365 INIT_LIST_HEAD(&rxq->rx_free);
3366 INIT_LIST_HEAD(&rxq->rx_used);
3367
3368 /* Fill the rx_used queue with _all_ of the Rx buffers */
3369 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3370 /* In the reset function, these buffers may have been allocated
3371 * to an SKB, so we need to unmap and free potential storage */
3372 if (rxq->pool[i].skb != NULL) {
3373 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003374 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003375 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003376 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003377 }
3378 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3379 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003380
James Ketrenos43f66a62005-03-25 12:31:53 -06003381 /* Set us so that we have processed and used all buffers, but have
3382 * not restocked the Rx queue with fresh buffers */
3383 rxq->read = rxq->write = 0;
3384 rxq->processed = RX_QUEUE_SIZE - 1;
3385 rxq->free_count = 0;
3386 spin_unlock_irqrestore(&rxq->lock, flags);
3387}
3388
3389#ifdef CONFIG_PM
3390static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003391static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003392
3393static void free_firmware(void)
3394{
3395 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003396 release_firmware(raw);
3397 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003398 fw_loaded = 0;
3399 }
3400}
3401#else
3402#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003403#endif
3404
3405static int ipw_load(struct ipw_priv *priv)
3406{
3407#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003408 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003409#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003410 struct ipw_fw *fw;
3411 u8 *boot_img, *ucode_img, *fw_img;
3412 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003413 int rc = 0, retries = 3;
3414
Zhu Yi397ae122006-01-24 16:37:22 +08003415 switch (priv->ieee->iw_mode) {
3416 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003417 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003418 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003419#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003420 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003421 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003422 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003423#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003424 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003425 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003426 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003427 }
Zhu Yi397ae122006-01-24 16:37:22 +08003428
James Ketrenos9006ea72006-03-08 03:22:28 +08003429 if (!name) {
3430 rc = -EINVAL;
3431 goto error;
3432 }
3433
3434#ifdef CONFIG_PM
3435 if (!fw_loaded) {
3436#endif
3437 rc = ipw_get_fw(priv, &raw, name);
3438 if (rc < 0)
3439 goto error;
3440#ifdef CONFIG_PM
3441 }
3442#endif
3443
3444 fw = (void *)raw->data;
3445 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003446 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3447 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3448 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003449
Zhu Yi397ae122006-01-24 16:37:22 +08003450 if (rc < 0)
3451 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003452
3453 if (!priv->rxq)
3454 priv->rxq = ipw_rx_queue_alloc(priv);
3455 else
3456 ipw_rx_queue_reset(priv, priv->rxq);
3457 if (!priv->rxq) {
3458 IPW_ERROR("Unable to initialize Rx queue\n");
3459 goto error;
3460 }
3461
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003462 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003463 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003464 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003465 priv->status &= ~STATUS_INT_ENABLED;
3466
3467 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003468 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003469
James Ketrenos43f66a62005-03-25 12:31:53 -06003470 ipw_stop_nic(priv);
3471
3472 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003473 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003474 IPW_ERROR("Unable to reset NIC\n");
3475 goto error;
3476 }
3477
James Ketrenosb095c382005-08-24 22:04:42 -05003478 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3479 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003480
3481 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003482 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003483 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003484 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003485 goto error;
3486 }
3487
3488 /* kick start the device */
3489 ipw_start_nic(priv);
3490
Zhu Yic7b6a672006-01-24 16:37:05 +08003491 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003492 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3493 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003494 if (rc < 0) {
3495 IPW_ERROR("device failed to boot initial fw image\n");
3496 goto error;
3497 }
3498 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3499
Jeff Garzikbf794512005-07-31 13:07:26 -04003500 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003501 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003502
3503 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003504 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003505 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003506 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003507 goto error;
3508 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003509
James Ketrenos43f66a62005-03-25 12:31:53 -06003510 /* stop nic */
3511 ipw_stop_nic(priv);
3512
3513 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003514 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003515 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003516 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003517 goto error;
3518 }
Zhu Yi397ae122006-01-24 16:37:22 +08003519#ifdef CONFIG_PM
3520 fw_loaded = 1;
3521#endif
3522
James Ketrenos43f66a62005-03-25 12:31:53 -06003523 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3524
3525 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003526 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003527 IPW_ERROR("Unable to initialize queues\n");
3528 goto error;
3529 }
3530
3531 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003532 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003533 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003534 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003535
James Ketrenos43f66a62005-03-25 12:31:53 -06003536 /* kick start the device */
3537 ipw_start_nic(priv);
3538
James Ketrenosb095c382005-08-24 22:04:42 -05003539 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003540 if (retries > 0) {
3541 IPW_WARNING("Parity error. Retrying init.\n");
3542 retries--;
3543 goto retry;
3544 }
3545
3546 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3547 rc = -EIO;
3548 goto error;
3549 }
3550
3551 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003552 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3553 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003554 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003555 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003556 goto error;
3557 }
3558 IPW_DEBUG_INFO("device response after %dms\n", rc);
3559
3560 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003561 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003562
3563 /* read eeprom data and initialize the eeprom region of sram */
3564 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003565 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003566
3567 /* enable interrupts */
3568 ipw_enable_interrupts(priv);
3569
3570 /* Ensure our queue has valid packets */
3571 ipw_rx_queue_replenish(priv);
3572
James Ketrenosb095c382005-08-24 22:04:42 -05003573 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003574
3575 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003576 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003577
3578#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003579 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003580#endif
3581 return 0;
3582
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003583 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003584 if (priv->rxq) {
3585 ipw_rx_queue_free(priv, priv->rxq);
3586 priv->rxq = NULL;
3587 }
3588 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003589 if (raw)
3590 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003591#ifdef CONFIG_PM
3592 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003593 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003594#endif
3595
3596 return rc;
3597}
3598
Jeff Garzikbf794512005-07-31 13:07:26 -04003599/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003600 * DMA services
3601 *
3602 * Theory of operation
3603 *
3604 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3605 * 2 empty entries always kept in the buffer to protect from overflow.
3606 *
3607 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003608 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3609 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003610 * Tx queue resumed.
3611 *
3612 * The IPW operates with six queues, one receive queue in the device's
3613 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003614 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003615 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003616 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003617 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003618 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003619 * we only utilize the first data transmit queue (queue1).
3620 */
3621
3622/**
3623 * Driver allocates buffers of this size for Rx
3624 */
3625
3626static inline int ipw_queue_space(const struct clx2_queue *q)
3627{
3628 int s = q->last_used - q->first_empty;
3629 if (s <= 0)
3630 s += q->n_bd;
3631 s -= 2; /* keep some reserve to not confuse empty and full situations */
3632 if (s < 0)
3633 s = 0;
3634 return s;
3635}
3636
3637static inline int ipw_queue_inc_wrap(int index, int n_bd)
3638{
3639 return (++index == n_bd) ? 0 : index;
3640}
3641
3642/**
3643 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003644 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003645 * @param q queue to init
3646 * @param count Number of BD's to allocate. Should be power of 2
3647 * @param read_register Address for 'read' register
3648 * (not offset within BAR, full address)
3649 * @param write_register Address for 'write' register
3650 * (not offset within BAR, full address)
3651 * @param base_register Address for 'base' register
3652 * (not offset within BAR, full address)
3653 * @param size Address for 'size' register
3654 * (not offset within BAR, full address)
3655 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003656static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003657 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003658{
3659 q->n_bd = count;
3660
3661 q->low_mark = q->n_bd / 4;
3662 if (q->low_mark < 4)
3663 q->low_mark = 4;
3664
3665 q->high_mark = q->n_bd / 8;
3666 if (q->high_mark < 2)
3667 q->high_mark = 2;
3668
3669 q->first_empty = q->last_used = 0;
3670 q->reg_r = read;
3671 q->reg_w = write;
3672
3673 ipw_write32(priv, base, q->dma_addr);
3674 ipw_write32(priv, size, count);
3675 ipw_write32(priv, read, 0);
3676 ipw_write32(priv, write, 0);
3677
3678 _ipw_read32(priv, 0x90);
3679}
3680
Jeff Garzikbf794512005-07-31 13:07:26 -04003681static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003682 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003683 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003684{
3685 struct pci_dev *dev = priv->pci_dev;
3686
3687 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3688 if (!q->txb) {
3689 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3690 return -ENOMEM;
3691 }
3692
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003693 q->bd =
3694 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003695 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003696 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003697 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003698 kfree(q->txb);
3699 q->txb = NULL;
3700 return -ENOMEM;
3701 }
3702
3703 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3704 return 0;
3705}
3706
3707/**
3708 * Free one TFD, those at index [txq->q.last_used].
3709 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003710 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003711 * @param dev
3712 * @param txq
3713 */
3714static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3715 struct clx2_tx_queue *txq)
3716{
3717 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3718 struct pci_dev *dev = priv->pci_dev;
3719 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003720
James Ketrenos43f66a62005-03-25 12:31:53 -06003721 /* classify bd */
3722 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3723 /* nothing to cleanup after for host commands */
3724 return;
3725
3726 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003727 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3728 IPW_ERROR("Too many chunks: %i\n",
3729 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003730 /** @todo issue fatal error, it is quite serious situation */
3731 return;
3732 }
3733
3734 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003735 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3736 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3737 le16_to_cpu(bd->u.data.chunk_len[i]),
3738 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003739 if (txq->txb[txq->q.last_used]) {
3740 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3741 txq->txb[txq->q.last_used] = NULL;
3742 }
3743 }
3744}
3745
3746/**
3747 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003748 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003749 * Empty queue by removing and destroying all BD's.
3750 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003751 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003752 * @param dev
3753 * @param q
3754 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003755static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003756{
3757 struct clx2_queue *q = &txq->q;
3758 struct pci_dev *dev = priv->pci_dev;
3759
Jeff Garzikbf794512005-07-31 13:07:26 -04003760 if (q->n_bd == 0)
3761 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003762
3763 /* first, empty all BD's */
3764 for (; q->first_empty != q->last_used;
3765 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3766 ipw_queue_tx_free_tfd(priv, txq);
3767 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003768
James Ketrenos43f66a62005-03-25 12:31:53 -06003769 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003770 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003771 q->dma_addr);
3772 kfree(txq->txb);
3773
3774 /* 0 fill whole structure */
3775 memset(txq, 0, sizeof(*txq));
3776}
3777
James Ketrenos43f66a62005-03-25 12:31:53 -06003778/**
3779 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003780 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003781 * @param priv
3782 */
3783static void ipw_tx_queue_free(struct ipw_priv *priv)
3784{
3785 /* Tx CMD queue */
3786 ipw_queue_tx_free(priv, &priv->txq_cmd);
3787
3788 /* Tx queues */
3789 ipw_queue_tx_free(priv, &priv->txq[0]);
3790 ipw_queue_tx_free(priv, &priv->txq[1]);
3791 ipw_queue_tx_free(priv, &priv->txq[2]);
3792 ipw_queue_tx_free(priv, &priv->txq[3]);
3793}
3794
Arjan van de Ven858119e2006-01-14 13:20:43 -08003795static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003796{
3797 /* First 3 bytes are manufacturer */
3798 bssid[0] = priv->mac_addr[0];
3799 bssid[1] = priv->mac_addr[1];
3800 bssid[2] = priv->mac_addr[2];
3801
3802 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003803 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003804
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003805 bssid[0] &= 0xfe; /* clear multicast bit */
3806 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003807}
3808
Arjan van de Ven858119e2006-01-14 13:20:43 -08003809static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003810{
3811 struct ipw_station_entry entry;
3812 int i;
Joe Perches0795af52007-10-03 17:59:30 -07003813 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06003814
3815 for (i = 0; i < priv->num_stations; i++) {
3816 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3817 /* Another node is active in network */
3818 priv->missed_adhoc_beacons = 0;
3819 if (!(priv->config & CFG_STATIC_CHANNEL))
3820 /* when other nodes drop out, we drop out */
3821 priv->config &= ~CFG_ADHOC_PERSIST;
3822
3823 return i;
3824 }
3825 }
3826
3827 if (i == MAX_STATIONS)
3828 return IPW_INVALID_STATION;
3829
Joe Perches0795af52007-10-03 17:59:30 -07003830 IPW_DEBUG_SCAN("Adding AdHoc station: %s\n", print_mac(mac, bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06003831
3832 entry.reserved = 0;
3833 entry.support_mode = 0;
3834 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3835 memcpy(priv->stations[i], bssid, ETH_ALEN);
3836 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003837 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003838 priv->num_stations++;
3839
3840 return i;
3841}
3842
Arjan van de Ven858119e2006-01-14 13:20:43 -08003843static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003844{
3845 int i;
3846
Jeff Garzikbf794512005-07-31 13:07:26 -04003847 for (i = 0; i < priv->num_stations; i++)
3848 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003849 return i;
3850
3851 return IPW_INVALID_STATION;
3852}
3853
3854static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3855{
3856 int err;
Joe Perches0795af52007-10-03 17:59:30 -07003857 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06003858
Hong Liu7b996592005-08-25 17:36:13 +08003859 if (priv->status & STATUS_ASSOCIATING) {
3860 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3861 queue_work(priv->workqueue, &priv->disassociate);
3862 return;
3863 }
3864
3865 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003866 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3867 return;
3868 }
3869
Joe Perches0795af52007-10-03 17:59:30 -07003870 IPW_DEBUG_ASSOC("Disassocation attempt from %s "
James Ketrenos43f66a62005-03-25 12:31:53 -06003871 "on channel %d.\n",
Joe Perches0795af52007-10-03 17:59:30 -07003872 print_mac(mac, priv->assoc_request.bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06003873 priv->assoc_request.channel);
3874
3875 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3876 priv->status |= STATUS_DISASSOCIATING;
3877
3878 if (quiet)
3879 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3880 else
3881 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003882
James Ketrenos43f66a62005-03-25 12:31:53 -06003883 err = ipw_send_associate(priv, &priv->assoc_request);
3884 if (err) {
3885 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3886 "failed.\n");
3887 return;
3888 }
3889
3890}
3891
James Ketrenosc848d0a2005-08-24 21:56:24 -05003892static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003893{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003894 struct ipw_priv *priv = data;
3895 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3896 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003897 ipw_send_disassociate(data, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003898 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003899}
3900
David Howellsc4028952006-11-22 14:57:56 +00003901static void ipw_bg_disassociate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06003902{
David Howellsc4028952006-11-22 14:57:56 +00003903 struct ipw_priv *priv =
3904 container_of(work, struct ipw_priv, disassociate);
Zhu Yi46441512006-01-24 16:37:59 +08003905 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00003906 ipw_disassociate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08003907 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003908}
3909
David Howellsc4028952006-11-22 14:57:56 +00003910static void ipw_system_config(struct work_struct *work)
Zhu Yid8bad6d2005-07-13 12:25:38 -05003911{
David Howellsc4028952006-11-22 14:57:56 +00003912 struct ipw_priv *priv =
3913 container_of(work, struct ipw_priv, system_config);
Zhu Yid685b8c2006-04-13 17:20:27 +08003914
3915#ifdef CONFIG_IPW2200_PROMISCUOUS
3916 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3917 priv->sys_config.accept_all_data_frames = 1;
3918 priv->sys_config.accept_non_directed_frames = 1;
3919 priv->sys_config.accept_all_mgmt_bcpr = 1;
3920 priv->sys_config.accept_all_mgmt_frames = 1;
3921 }
3922#endif
3923
3924 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003925}
3926
3927struct ipw_status_code {
3928 u16 status;
3929 const char *reason;
3930};
3931
3932static const struct ipw_status_code ipw_status_codes[] = {
3933 {0x00, "Successful"},
3934 {0x01, "Unspecified failure"},
3935 {0x0A, "Cannot support all requested capabilities in the "
3936 "Capability information field"},
3937 {0x0B, "Reassociation denied due to inability to confirm that "
3938 "association exists"},
3939 {0x0C, "Association denied due to reason outside the scope of this "
3940 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003941 {0x0D,
3942 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003943 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003944 {0x0E,
3945 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003946 "transaction sequence number out of expected sequence"},
3947 {0x0F, "Authentication rejected because of challenge failure"},
3948 {0x10, "Authentication rejected due to timeout waiting for next "
3949 "frame in sequence"},
3950 {0x11, "Association denied because AP is unable to handle additional "
3951 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003952 {0x12,
3953 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003954 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003955 {0x13,
3956 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003957 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003958 {0x14,
3959 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003960 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003961 {0x15,
3962 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003963 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003964 {0x19,
3965 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003966 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003967 {0x1A,
3968 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003969 "DSSS-OFDM operation"},
3970 {0x28, "Invalid Information Element"},
3971 {0x29, "Group Cipher is not valid"},
3972 {0x2A, "Pairwise Cipher is not valid"},
3973 {0x2B, "AKMP is not valid"},
3974 {0x2C, "Unsupported RSN IE version"},
3975 {0x2D, "Invalid RSN IE Capabilities"},
3976 {0x2E, "Cipher suite is rejected per security policy"},
3977};
3978
Jeff Garzikbf794512005-07-31 13:07:26 -04003979static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003980{
3981 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003982 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003983 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003984 return ipw_status_codes[i].reason;
3985 return "Unknown status value.";
3986}
James Ketrenos43f66a62005-03-25 12:31:53 -06003987
3988static void inline average_init(struct average *avg)
3989{
3990 memset(avg, 0, sizeof(*avg));
3991}
3992
Zhu Yi00d21de2006-04-13 17:19:02 +08003993#define DEPTH_RSSI 8
3994#define DEPTH_NOISE 16
3995static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
3996{
3997 return ((depth-1)*prev_avg + val)/depth;
3998}
3999
Arjan van de Ven858119e2006-01-14 13:20:43 -08004000static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06004001{
4002 avg->sum -= avg->entries[avg->pos];
4003 avg->sum += val;
4004 avg->entries[avg->pos++] = val;
4005 if (unlikely(avg->pos == AVG_ENTRIES)) {
4006 avg->init = 1;
4007 avg->pos = 0;
4008 }
4009}
4010
Arjan van de Ven858119e2006-01-14 13:20:43 -08004011static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06004012{
4013 if (!unlikely(avg->init)) {
4014 if (avg->pos)
4015 return avg->sum / avg->pos;
4016 return 0;
4017 }
4018
4019 return avg->sum / AVG_ENTRIES;
4020}
4021
4022static void ipw_reset_stats(struct ipw_priv *priv)
4023{
4024 u32 len = sizeof(u32);
4025
4026 priv->quality = 0;
4027
4028 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08004029 priv->exp_avg_rssi = -60;
4030 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06004031
4032 priv->last_rate = 0;
4033 priv->last_missed_beacons = 0;
4034 priv->last_rx_packets = 0;
4035 priv->last_tx_packets = 0;
4036 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04004037
James Ketrenos43f66a62005-03-25 12:31:53 -06004038 /* Firmware managed, reset only when NIC is restarted, so we have to
4039 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04004040 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06004041 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04004042 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06004043 &priv->last_tx_failures, &len);
4044
4045 /* Driver managed, reset with each association */
4046 priv->missed_adhoc_beacons = 0;
4047 priv->missed_beacons = 0;
4048 priv->tx_packets = 0;
4049 priv->rx_packets = 0;
4050
4051}
4052
Arjan van de Ven858119e2006-01-14 13:20:43 -08004053static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06004054{
4055 u32 i = 0x80000000;
4056 u32 mask = priv->rates_mask;
4057 /* If currently associated in B mode, restrict the maximum
4058 * rate match to B rates */
4059 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
4060 mask &= IEEE80211_CCK_RATES_MASK;
4061
4062 /* TODO: Verify that the rate is supported by the current rates
4063 * list. */
4064
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004065 while (i && !(mask & i))
4066 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06004067 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004068 case IEEE80211_CCK_RATE_1MB_MASK:
4069 return 1000000;
4070 case IEEE80211_CCK_RATE_2MB_MASK:
4071 return 2000000;
4072 case IEEE80211_CCK_RATE_5MB_MASK:
4073 return 5500000;
4074 case IEEE80211_OFDM_RATE_6MB_MASK:
4075 return 6000000;
4076 case IEEE80211_OFDM_RATE_9MB_MASK:
4077 return 9000000;
4078 case IEEE80211_CCK_RATE_11MB_MASK:
4079 return 11000000;
4080 case IEEE80211_OFDM_RATE_12MB_MASK:
4081 return 12000000;
4082 case IEEE80211_OFDM_RATE_18MB_MASK:
4083 return 18000000;
4084 case IEEE80211_OFDM_RATE_24MB_MASK:
4085 return 24000000;
4086 case IEEE80211_OFDM_RATE_36MB_MASK:
4087 return 36000000;
4088 case IEEE80211_OFDM_RATE_48MB_MASK:
4089 return 48000000;
4090 case IEEE80211_OFDM_RATE_54MB_MASK:
4091 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004092 }
4093
Jeff Garzikbf794512005-07-31 13:07:26 -04004094 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004095 return 11000000;
4096 else
4097 return 54000000;
4098}
4099
4100static u32 ipw_get_current_rate(struct ipw_priv *priv)
4101{
4102 u32 rate, len = sizeof(rate);
4103 int err;
4104
Jeff Garzikbf794512005-07-31 13:07:26 -04004105 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004106 return 0;
4107
4108 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004109 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004110 &len);
4111 if (err) {
4112 IPW_DEBUG_INFO("failed querying ordinals.\n");
4113 return 0;
4114 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004115 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004116 return ipw_get_max_rate(priv);
4117
4118 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004119 case IPW_TX_RATE_1MB:
4120 return 1000000;
4121 case IPW_TX_RATE_2MB:
4122 return 2000000;
4123 case IPW_TX_RATE_5MB:
4124 return 5500000;
4125 case IPW_TX_RATE_6MB:
4126 return 6000000;
4127 case IPW_TX_RATE_9MB:
4128 return 9000000;
4129 case IPW_TX_RATE_11MB:
4130 return 11000000;
4131 case IPW_TX_RATE_12MB:
4132 return 12000000;
4133 case IPW_TX_RATE_18MB:
4134 return 18000000;
4135 case IPW_TX_RATE_24MB:
4136 return 24000000;
4137 case IPW_TX_RATE_36MB:
4138 return 36000000;
4139 case IPW_TX_RATE_48MB:
4140 return 48000000;
4141 case IPW_TX_RATE_54MB:
4142 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004143 }
4144
4145 return 0;
4146}
4147
James Ketrenos43f66a62005-03-25 12:31:53 -06004148#define IPW_STATS_INTERVAL (2 * HZ)
4149static void ipw_gather_stats(struct ipw_priv *priv)
4150{
4151 u32 rx_err, rx_err_delta, rx_packets_delta;
4152 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4153 u32 missed_beacons_percent, missed_beacons_delta;
4154 u32 quality = 0;
4155 u32 len = sizeof(u32);
4156 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004157 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004158 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004159 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004160
4161 if (!(priv->status & STATUS_ASSOCIATED)) {
4162 priv->quality = 0;
4163 return;
4164 }
4165
4166 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004167 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004168 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004169 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004170 priv->last_missed_beacons = priv->missed_beacons;
4171 if (priv->assoc_request.beacon_interval) {
4172 missed_beacons_percent = missed_beacons_delta *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004173 (HZ * priv->assoc_request.beacon_interval) /
4174 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004175 } else {
4176 missed_beacons_percent = 0;
4177 }
4178 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4179
4180 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4181 rx_err_delta = rx_err - priv->last_rx_err;
4182 priv->last_rx_err = rx_err;
4183
4184 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4185 tx_failures_delta = tx_failures - priv->last_tx_failures;
4186 priv->last_tx_failures = tx_failures;
4187
4188 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4189 priv->last_rx_packets = priv->rx_packets;
4190
4191 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4192 priv->last_tx_packets = priv->tx_packets;
4193
4194 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004195 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004196 * Missed beacon: 100% = 0, 0% = 70% missed
4197 * Rate: 60% = 1Mbs, 100% = Max
4198 * Rx and Tx errors represent a straight % of total Rx/Tx
4199 * RSSI: 100% = > -50, 0% = < -80
4200 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004201 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004202 * The lowest computed quality is used.
4203 *
4204 */
4205#define BEACON_THRESHOLD 5
4206 beacon_quality = 100 - missed_beacons_percent;
4207 if (beacon_quality < BEACON_THRESHOLD)
4208 beacon_quality = 0;
4209 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004210 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004211 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004212 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004213 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004214
James Ketrenos43f66a62005-03-25 12:31:53 -06004215 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004216 max_rate = ipw_get_max_rate(priv);
4217 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004218 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4219 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004220
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004221 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004222 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004223 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004224 else
4225 rx_quality = 100;
4226 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4227 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004228
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004229 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004230 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004231 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004232 else
4233 tx_quality = 100;
4234 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4235 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004236
Zhu Yi00d21de2006-04-13 17:19:02 +08004237 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004238 signal_quality =
4239 (100 *
4240 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4241 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4242 (priv->ieee->perfect_rssi - rssi) *
4243 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4244 62 * (priv->ieee->perfect_rssi - rssi))) /
4245 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4246 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4247 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004248 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004249 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004250 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004251
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004252 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004253 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004254
4255 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004256 min(rate_quality,
4257 min(tx_quality, min(rx_quality, signal_quality))));
4258 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004259 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4260 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004261 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004262 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4263 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004264 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004265 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4266 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004267 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004268 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4269 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004270 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004271 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4272 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004273
4274 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004275
4276 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004277 IPW_STATS_INTERVAL);
4278}
4279
David Howellsc4028952006-11-22 14:57:56 +00004280static void ipw_bg_gather_stats(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05004281{
David Howellsc4028952006-11-22 14:57:56 +00004282 struct ipw_priv *priv =
4283 container_of(work, struct ipw_priv, gather_stats.work);
Zhu Yi46441512006-01-24 16:37:59 +08004284 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00004285 ipw_gather_stats(priv);
Zhu Yi46441512006-01-24 16:37:59 +08004286 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004287}
4288
Ben Cahille7582562005-10-06 15:34:41 -05004289/* Missed beacon behavior:
4290 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4291 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4292 * Above disassociate threshold, give up and stop scanning.
4293 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004294static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004295 int missed_count)
4296{
4297 priv->notif_missed_beacons = missed_count;
4298
James Ketrenosafbf30a2005-08-25 00:05:33 -05004299 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004300 priv->status & STATUS_ASSOCIATED) {
4301 /* If associated and we've hit the missed
4302 * beacon threshold, disassociate, turn
4303 * off roaming, and abort any active scans */
4304 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004305 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004306 "Missed beacon: %d - disassociate\n", missed_count);
4307 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004308 if (priv->status & STATUS_SCANNING) {
4309 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4310 IPW_DL_STATE,
4311 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004312 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004313 }
4314
James Ketrenosea2b26e2005-08-24 21:25:16 -05004315 queue_work(priv->workqueue, &priv->disassociate);
4316 return;
4317 }
4318
4319 if (priv->status & STATUS_ROAMING) {
4320 /* If we are currently roaming, then just
4321 * print a debug statement... */
4322 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4323 "Missed beacon: %d - roam in progress\n",
4324 missed_count);
4325 return;
4326 }
4327
Zhu Yi4bfdb912006-01-24 16:37:16 +08004328 if (roaming &&
4329 (missed_count > priv->roaming_threshold &&
4330 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004331 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004332 * bit in the status and kick off a scan.
4333 * This can happen several times before we reach
4334 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004335 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4336 "Missed beacon: %d - initiate "
4337 "roaming\n", missed_count);
4338 if (!(priv->status & STATUS_ROAMING)) {
4339 priv->status |= STATUS_ROAMING;
4340 if (!(priv->status & STATUS_SCANNING))
David Howellsc4028952006-11-22 14:57:56 +00004341 queue_delayed_work(priv->workqueue,
4342 &priv->request_scan, 0);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004343 }
4344 return;
4345 }
4346
4347 if (priv->status & STATUS_SCANNING) {
4348 /* Stop scan to keep fw from getting
4349 * stuck (only if we aren't roaming --
4350 * otherwise we'll never scan more than 2 or 3
4351 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004352 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4353 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004354 queue_work(priv->workqueue, &priv->abort_scan);
4355 }
4356
4357 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004358}
4359
Dan Williams0b531672007-10-09 13:55:24 -04004360static void ipw_scan_event(struct work_struct *work)
4361{
4362 union iwreq_data wrqu;
4363
4364 struct ipw_priv *priv =
4365 container_of(work, struct ipw_priv, scan_event.work);
4366
4367 wrqu.data.length = 0;
4368 wrqu.data.flags = 0;
4369 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4370}
4371
4372static void handle_scan_event(struct ipw_priv *priv)
4373{
4374 /* Only userspace-requested scan completion events go out immediately */
4375 if (!priv->user_requested_scan) {
4376 if (!delayed_work_pending(&priv->scan_event))
4377 queue_delayed_work(priv->workqueue, &priv->scan_event,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004378 round_jiffies_relative(msecs_to_jiffies(4000)));
Dan Williams0b531672007-10-09 13:55:24 -04004379 } else {
4380 union iwreq_data wrqu;
4381
4382 priv->user_requested_scan = 0;
4383 cancel_delayed_work(&priv->scan_event);
4384
4385 wrqu.data.length = 0;
4386 wrqu.data.flags = 0;
4387 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4388 }
4389}
4390
James Ketrenos43f66a62005-03-25 12:31:53 -06004391/**
4392 * Handle host notification packet.
4393 * Called from interrupt routine
4394 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004395static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004396 struct ipw_rx_notification *notif)
4397{
Joe Perches0795af52007-10-03 17:59:30 -07004398 DECLARE_MAC_BUF(mac);
James Ketrenosa613bff2005-08-24 21:43:11 -05004399 notif->size = le16_to_cpu(notif->size);
4400
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004401 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, notif->size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004402
James Ketrenos43f66a62005-03-25 12:31:53 -06004403 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004404 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4405 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004406
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004407 switch (assoc->state) {
4408 case CMAS_ASSOCIATED:{
4409 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4410 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004411 "associated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004412 " \n",
4413 escape_essid(priv->essid,
4414 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004415 print_mac(mac, priv->bssid));
Jeff Garzikbf794512005-07-31 13:07:26 -04004416
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004417 switch (priv->ieee->iw_mode) {
4418 case IW_MODE_INFRA:
4419 memcpy(priv->ieee->bssid,
4420 priv->bssid, ETH_ALEN);
4421 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004422
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004423 case IW_MODE_ADHOC:
4424 memcpy(priv->ieee->bssid,
4425 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004426
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004427 /* clear out the station table */
4428 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004429
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004430 IPW_DEBUG_ASSOC
4431 ("queueing adhoc check\n");
4432 queue_delayed_work(priv->
4433 workqueue,
4434 &priv->
4435 adhoc_check,
4436 priv->
4437 assoc_request.
4438 beacon_interval);
4439 break;
4440 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004441
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004442 priv->status &= ~STATUS_ASSOCIATING;
4443 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004444 queue_work(priv->workqueue,
4445 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004446
Zhu Yie43e3c12006-04-13 17:20:45 +08004447#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004448#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
4449 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_ctl))
4450 if ((priv->status & STATUS_AUTH) &&
4451 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4452 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004453 if ((sizeof
4454 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004455 ieee80211_assoc_response)
James Ketrenosb095c382005-08-24 22:04:42 -05004456 <= notif->size)
4457 && (notif->size <= 2314)) {
4458 struct
4459 ieee80211_rx_stats
4460 stats = {
4461 .len =
4462 notif->
4463 size - 1,
4464 };
4465
4466 IPW_DEBUG_QOS
4467 ("QoS Associate "
4468 "size %d\n",
4469 notif->size);
4470 ieee80211_rx_mgt(priv->
4471 ieee,
4472 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004473 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004474 *)
4475 &notif->u.raw, &stats);
4476 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004477 }
James Ketrenosb095c382005-08-24 22:04:42 -05004478#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004479
James Ketrenosa613bff2005-08-24 21:43:11 -05004480 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004481
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004482 break;
4483 }
4484
4485 case CMAS_AUTHENTICATED:{
4486 if (priv->
4487 status & (STATUS_ASSOCIATED |
4488 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004489 struct notif_authenticate *auth
4490 = &notif->u.auth;
4491 IPW_DEBUG(IPW_DL_NOTIF |
4492 IPW_DL_STATE |
4493 IPW_DL_ASSOC,
4494 "deauthenticated: '%s' "
Joe Perches0795af52007-10-03 17:59:30 -07004495 "%s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004496 ": (0x%04X) - %s \n",
4497 escape_essid(priv->
4498 essid,
4499 priv->
4500 essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004501 print_mac(mac, priv->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004502 ntohs(auth->status),
4503 ipw_get_status_code
4504 (ntohs
4505 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004506
4507 priv->status &=
4508 ~(STATUS_ASSOCIATING |
4509 STATUS_AUTH |
4510 STATUS_ASSOCIATED);
4511
James Ketrenosa613bff2005-08-24 21:43:11 -05004512 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004513 break;
4514 }
4515
4516 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4517 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004518 "authenticated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004519 "\n",
4520 escape_essid(priv->essid,
4521 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004522 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004523 break;
4524 }
4525
4526 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004527 if (priv->status & STATUS_AUTH) {
4528 struct
4529 ieee80211_assoc_response
4530 *resp;
4531 resp =
4532 (struct
4533 ieee80211_assoc_response
4534 *)&notif->u.raw;
4535 IPW_DEBUG(IPW_DL_NOTIF |
4536 IPW_DL_STATE |
4537 IPW_DL_ASSOC,
4538 "association failed (0x%04X): %s\n",
4539 ntohs(resp->status),
4540 ipw_get_status_code
4541 (ntohs
4542 (resp->status)));
4543 }
4544
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004545 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4546 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004547 "disassociated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004548 " \n",
4549 escape_essid(priv->essid,
4550 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004551 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004552
4553 priv->status &=
4554 ~(STATUS_DISASSOCIATING |
4555 STATUS_ASSOCIATING |
4556 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004557 if (priv->assoc_network
4558 && (priv->assoc_network->
4559 capability &
4560 WLAN_CAPABILITY_IBSS))
4561 ipw_remove_current_network
4562 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004563
James Ketrenosa613bff2005-08-24 21:43:11 -05004564 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004565
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004566 break;
4567 }
4568
James Ketrenosb095c382005-08-24 22:04:42 -05004569 case CMAS_RX_ASSOC_RESP:
4570 break;
4571
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004572 default:
4573 IPW_ERROR("assoc: unknown (%d)\n",
4574 assoc->state);
4575 break;
4576 }
4577
James Ketrenos43f66a62005-03-25 12:31:53 -06004578 break;
4579 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004580
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004581 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4582 struct notif_authenticate *auth = &notif->u.auth;
4583 switch (auth->state) {
4584 case CMAS_AUTHENTICATED:
4585 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Joe Perches0795af52007-10-03 17:59:30 -07004586 "authenticated: '%s' %s \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004587 escape_essid(priv->essid,
4588 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004589 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004590 priv->status |= STATUS_AUTH;
4591 break;
4592
4593 case CMAS_INIT:
4594 if (priv->status & STATUS_AUTH) {
4595 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4596 IPW_DL_ASSOC,
4597 "authentication failed (0x%04X): %s\n",
4598 ntohs(auth->status),
4599 ipw_get_status_code(ntohs
4600 (auth->
4601 status)));
4602 }
4603 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4604 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004605 "deauthenticated: '%s' %s\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004606 escape_essid(priv->essid,
4607 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004608 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06004609
4610 priv->status &= ~(STATUS_ASSOCIATING |
4611 STATUS_AUTH |
4612 STATUS_ASSOCIATED);
4613
James Ketrenosa613bff2005-08-24 21:43:11 -05004614 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004615 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004616
4617 case CMAS_TX_AUTH_SEQ_1:
4618 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4619 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4620 break;
4621 case CMAS_RX_AUTH_SEQ_2:
4622 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4623 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4624 break;
4625 case CMAS_AUTH_SEQ_1_PASS:
4626 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4627 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4628 break;
4629 case CMAS_AUTH_SEQ_1_FAIL:
4630 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4631 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4632 break;
4633 case CMAS_TX_AUTH_SEQ_3:
4634 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4635 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4636 break;
4637 case CMAS_RX_AUTH_SEQ_4:
4638 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4639 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4640 break;
4641 case CMAS_AUTH_SEQ_2_PASS:
4642 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4643 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4644 break;
4645 case CMAS_AUTH_SEQ_2_FAIL:
4646 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4647 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4648 break;
4649 case CMAS_TX_ASSOC:
4650 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4651 IPW_DL_ASSOC, "TX_ASSOC\n");
4652 break;
4653 case CMAS_RX_ASSOC_RESP:
4654 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4655 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004656
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004657 break;
4658 case CMAS_ASSOCIATED:
4659 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4660 IPW_DL_ASSOC, "ASSOCIATED\n");
4661 break;
4662 default:
4663 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4664 auth->state);
4665 break;
4666 }
4667 break;
4668 }
4669
4670 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4671 struct notif_channel_result *x =
4672 &notif->u.channel_result;
4673
4674 if (notif->size == sizeof(*x)) {
4675 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4676 x->channel_num);
4677 } else {
4678 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4679 "(should be %zd)\n",
4680 notif->size, sizeof(*x));
4681 }
4682 break;
4683 }
4684
4685 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4686 struct notif_scan_complete *x = &notif->u.scan_complete;
4687 if (notif->size == sizeof(*x)) {
4688 IPW_DEBUG_SCAN
4689 ("Scan completed: type %d, %d channels, "
4690 "%d status\n", x->scan_type,
4691 x->num_channels, x->status);
4692 } else {
4693 IPW_ERROR("Scan completed of wrong size %d "
4694 "(should be %zd)\n",
4695 notif->size, sizeof(*x));
4696 }
4697
4698 priv->status &=
4699 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4700
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004701 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004702 cancel_delayed_work(&priv->scan_check);
4703
James Ketrenosb095c382005-08-24 22:04:42 -05004704 if (priv->status & STATUS_EXIT_PENDING)
4705 break;
4706
4707 priv->ieee->scans++;
4708
4709#ifdef CONFIG_IPW2200_MONITOR
4710 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004711 priv->status |= STATUS_SCAN_FORCED;
David Howellsc4028952006-11-22 14:57:56 +00004712 queue_delayed_work(priv->workqueue,
4713 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05004714 break;
4715 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004716 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004717#endif /* CONFIG_IPW2200_MONITOR */
4718
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004719 if (!(priv->status & (STATUS_ASSOCIATED |
4720 STATUS_ASSOCIATING |
4721 STATUS_ROAMING |
4722 STATUS_DISASSOCIATING)))
4723 queue_work(priv->workqueue, &priv->associate);
4724 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004725 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4726 /* If a scan completed and we are in roam mode, then
4727 * the scan that completed was the one requested as a
4728 * result of entering roam... so, schedule the
4729 * roam work */
4730 queue_work(priv->workqueue,
4731 &priv->roam);
4732 else
4733 /* Don't schedule if we aborted the scan */
4734 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004735 } else if (priv->status & STATUS_SCAN_PENDING)
David Howellsc4028952006-11-22 14:57:56 +00004736 queue_delayed_work(priv->workqueue,
4737 &priv->request_scan, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05004738 else if (priv->config & CFG_BACKGROUND_SCAN
4739 && priv->status & STATUS_ASSOCIATED)
4740 queue_delayed_work(priv->workqueue,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07004741 &priv->request_scan,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004742 round_jiffies_relative(HZ));
Zhu Yi07f02e42006-04-13 17:19:25 +08004743
4744 /* Send an empty event to user space.
4745 * We don't send the received data on the event because
4746 * it would require us to do complex transcoding, and
4747 * we want to minimise the work done in the irq handler
4748 * Use a request to extract the data.
4749 * Also, we generate this even for any scan, regardless
4750 * on how the scan was initiated. User space can just
4751 * sync on periodic scan to get fresh data...
4752 * Jean II */
Dan Williams0b531672007-10-09 13:55:24 -04004753 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4754 handle_scan_event(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004755 break;
4756 }
4757
4758 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4759 struct notif_frag_length *x = &notif->u.frag_len;
4760
James Ketrenosa613bff2005-08-24 21:43:11 -05004761 if (notif->size == sizeof(*x))
4762 IPW_ERROR("Frag length: %d\n",
4763 le16_to_cpu(x->frag_length));
4764 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004765 IPW_ERROR("Frag length of wrong size %d "
4766 "(should be %zd)\n",
4767 notif->size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004768 break;
4769 }
4770
4771 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4772 struct notif_link_deterioration *x =
4773 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004774
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004775 if (notif->size == sizeof(*x)) {
4776 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004777 "link deterioration: type %d, cnt %d\n",
4778 x->silence_notification_type,
4779 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004780 memcpy(&priv->last_link_deterioration, x,
4781 sizeof(*x));
4782 } else {
4783 IPW_ERROR("Link Deterioration of wrong size %d "
4784 "(should be %zd)\n",
4785 notif->size, sizeof(*x));
4786 }
4787 break;
4788 }
4789
4790 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4791 IPW_ERROR("Dino config\n");
4792 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004793 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004794 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004795
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004796 break;
4797 }
4798
4799 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4800 struct notif_beacon_state *x = &notif->u.beacon_state;
4801 if (notif->size != sizeof(*x)) {
4802 IPW_ERROR
4803 ("Beacon state of wrong size %d (should "
4804 "be %zd)\n", notif->size, sizeof(*x));
4805 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004806 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004807
James Ketrenosa613bff2005-08-24 21:43:11 -05004808 if (le32_to_cpu(x->state) ==
4809 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4810 ipw_handle_missed_beacon(priv,
4811 le32_to_cpu(x->
4812 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004813
James Ketrenos43f66a62005-03-25 12:31:53 -06004814 break;
4815 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004816
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004817 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4818 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
4819 if (notif->size == sizeof(*x)) {
4820 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4821 "0x%02x station %d\n",
4822 x->key_state, x->security_type,
4823 x->station_index);
4824 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004825 }
4826
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004827 IPW_ERROR
4828 ("TGi Tx Key of wrong size %d (should be %zd)\n",
4829 notif->size, sizeof(*x));
4830 break;
4831 }
4832
4833 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4834 struct notif_calibration *x = &notif->u.calibration;
4835
4836 if (notif->size == sizeof(*x)) {
4837 memcpy(&priv->calib, x, sizeof(*x));
4838 IPW_DEBUG_INFO("TODO: Calibration\n");
4839 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004840 }
4841
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004842 IPW_ERROR
4843 ("Calibration of wrong size %d (should be %zd)\n",
4844 notif->size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004845 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004846 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004847
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004848 case HOST_NOTIFICATION_NOISE_STATS:{
4849 if (notif->size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004850 priv->exp_avg_noise =
4851 exponential_average(priv->exp_avg_noise,
4852 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4853 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004854 break;
4855 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004856
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004857 IPW_ERROR
4858 ("Noise stat is wrong size %d (should be %zd)\n",
4859 notif->size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004860 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004861 }
4862
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004864 IPW_DEBUG_NOTIF("Unknown notification: "
4865 "subtype=%d,flags=0x%2x,size=%d\n",
4866 notif->subtype, notif->flags, notif->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004867 }
4868}
4869
4870/**
4871 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004872 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004873 * @param priv
4874 * @return error code
4875 */
4876static int ipw_queue_reset(struct ipw_priv *priv)
4877{
4878 int rc = 0;
4879 /** @todo customize queue sizes */
4880 int nTx = 64, nTxCmd = 8;
4881 ipw_tx_queue_free(priv);
4882 /* Tx CMD queue */
4883 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004884 IPW_TX_CMD_QUEUE_READ_INDEX,
4885 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4886 IPW_TX_CMD_QUEUE_BD_BASE,
4887 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004888 if (rc) {
4889 IPW_ERROR("Tx Cmd queue init failed\n");
4890 goto error;
4891 }
4892 /* Tx queue(s) */
4893 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004894 IPW_TX_QUEUE_0_READ_INDEX,
4895 IPW_TX_QUEUE_0_WRITE_INDEX,
4896 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004897 if (rc) {
4898 IPW_ERROR("Tx 0 queue init failed\n");
4899 goto error;
4900 }
4901 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004902 IPW_TX_QUEUE_1_READ_INDEX,
4903 IPW_TX_QUEUE_1_WRITE_INDEX,
4904 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004905 if (rc) {
4906 IPW_ERROR("Tx 1 queue init failed\n");
4907 goto error;
4908 }
4909 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004910 IPW_TX_QUEUE_2_READ_INDEX,
4911 IPW_TX_QUEUE_2_WRITE_INDEX,
4912 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004913 if (rc) {
4914 IPW_ERROR("Tx 2 queue init failed\n");
4915 goto error;
4916 }
4917 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004918 IPW_TX_QUEUE_3_READ_INDEX,
4919 IPW_TX_QUEUE_3_WRITE_INDEX,
4920 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004921 if (rc) {
4922 IPW_ERROR("Tx 3 queue init failed\n");
4923 goto error;
4924 }
4925 /* statistics */
4926 priv->rx_bufs_min = 0;
4927 priv->rx_pend_max = 0;
4928 return rc;
4929
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004930 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004931 ipw_tx_queue_free(priv);
4932 return rc;
4933}
4934
4935/**
4936 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004937 *
Stefano Brivio8ff9d212008-01-12 23:12:26 +01004938 * When FW advances 'R' index, all entries between old and
James Ketrenos43f66a62005-03-25 12:31:53 -06004939 * new 'R' index need to be reclaimed. As result, some free space
4940 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004941 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004942 * @note Need to protect against garbage in 'R' index
4943 * @param priv
4944 * @param txq
4945 * @param qindex
4946 * @return Number of used entries remains in the queue
4947 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004948static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004949 struct clx2_tx_queue *txq, int qindex)
4950{
4951 u32 hw_tail;
4952 int used;
4953 struct clx2_queue *q = &txq->q;
4954
4955 hw_tail = ipw_read32(priv, q->reg_r);
4956 if (hw_tail >= q->n_bd) {
4957 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004958 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4959 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004960 goto done;
4961 }
4962 for (; q->last_used != hw_tail;
4963 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4964 ipw_queue_tx_free_tfd(priv, txq);
4965 priv->tx_packets++;
4966 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004967 done:
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004968 if ((ipw_queue_space(q) > q->low_mark) &&
4969 (qindex >= 0) &&
4970 (priv->status & STATUS_ASSOCIATED) && netif_running(priv->net_dev))
4971 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004972 used = q->first_empty - q->last_used;
4973 if (used < 0)
4974 used += q->n_bd;
4975
4976 return used;
4977}
4978
4979static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4980 int len, int sync)
4981{
4982 struct clx2_tx_queue *txq = &priv->txq_cmd;
4983 struct clx2_queue *q = &txq->q;
4984 struct tfd_frame *tfd;
4985
4986 if (ipw_queue_space(q) < (sync ? 1 : 2)) {
4987 IPW_ERROR("No space for Tx\n");
4988 return -EBUSY;
4989 }
4990
4991 tfd = &txq->bd[q->first_empty];
4992 txq->txb[q->first_empty] = NULL;
4993
4994 memset(tfd, 0, sizeof(*tfd));
4995 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
4996 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
4997 priv->hcmd_seq++;
4998 tfd->u.cmd.index = hcmd;
4999 tfd->u.cmd.length = len;
5000 memcpy(tfd->u.cmd.payload, buf, len);
5001 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
5002 ipw_write32(priv, q->reg_w, q->first_empty);
5003 _ipw_read32(priv, 0x90);
5004
5005 return 0;
5006}
5007
Jeff Garzikbf794512005-07-31 13:07:26 -04005008/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005009 * Rx theory of operation
5010 *
5011 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05005012 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06005013 * 0 to 31
5014 *
5015 * Rx Queue Indexes
5016 * The host/firmware share two index registers for managing the Rx buffers.
5017 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005018 * The READ index maps to the first position that the firmware may be writing
5019 * to -- the driver can read up to (but not including) this position and get
5020 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06005021 * The READ index is managed by the firmware once the card is enabled.
5022 *
5023 * The WRITE index maps to the last position the driver has read from -- the
5024 * position preceding WRITE is the last slot the firmware can place a packet.
5025 *
5026 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04005027 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06005028 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005029 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06005030 * INDEX position, and WRITE to the last (READ - 1 wrapped)
5031 *
5032 * When the firmware places a packet in a buffer it will advance the READ index
5033 * and fire the RX interrupt. The driver can then query the READ index and
5034 * process as many packets as possible, moving the WRITE index forward as it
5035 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04005036 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005037 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04005038 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06005039 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04005040 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06005041 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
5042 * ipw->rxq is replenished and the READ INDEX is updated (updating the
5043 * 'processed' and 'read' driver indexes as well)
5044 * + A received packet is processed and handed to the kernel network stack,
5045 * detached from the ipw->rxq. The driver 'processed' index is updated.
5046 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04005047 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
5048 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06005049 * were enough free buffers and RX_STALLED is set it is cleared.
5050 *
5051 *
5052 * Driver sequence:
5053 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005054 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06005055 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
5056 * ipw_rx_queue_restock
5057 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
5058 * queue, updates firmware pointers, and updates
5059 * the WRITE index. If insufficient rx_free buffers
5060 * are available, schedules ipw_rx_queue_replenish
5061 *
5062 * -- enable interrupts --
5063 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04005064 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06005065 * Moves the packet buffer from queue to rx_used.
5066 * Calls ipw_rx_queue_restock to refill any empty
5067 * slots.
5068 * ...
5069 *
5070 */
5071
Jeff Garzikbf794512005-07-31 13:07:26 -04005072/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005073 * If there are slots in the RX queue that need to be restocked,
5074 * and we have free pre-allocated buffers, fill the ranks as much
5075 * as we can pulling from rx_free.
5076 *
5077 * This moves the 'write' index forward to catch up with 'processed', and
5078 * also updates the memory address in the firmware to reference the new
5079 * target buffer.
5080 */
5081static void ipw_rx_queue_restock(struct ipw_priv *priv)
5082{
5083 struct ipw_rx_queue *rxq = priv->rxq;
5084 struct list_head *element;
5085 struct ipw_rx_mem_buffer *rxb;
5086 unsigned long flags;
5087 int write;
5088
5089 spin_lock_irqsave(&rxq->lock, flags);
5090 write = rxq->write;
5091 while ((rxq->write != rxq->processed) && (rxq->free_count)) {
5092 element = rxq->rx_free.next;
5093 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
5094 list_del(element);
5095
James Ketrenosb095c382005-08-24 22:04:42 -05005096 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005097 rxb->dma_addr);
5098 rxq->queue[rxq->write] = rxb;
5099 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5100 rxq->free_count--;
5101 }
5102 spin_unlock_irqrestore(&rxq->lock, flags);
5103
Jeff Garzikbf794512005-07-31 13:07:26 -04005104 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005105 * refill it */
5106 if (rxq->free_count <= RX_LOW_WATERMARK)
5107 queue_work(priv->workqueue, &priv->rx_replenish);
5108
5109 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005110 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005111 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005112}
5113
5114/*
5115 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005116 * Also restock the Rx queue via ipw_rx_queue_restock.
5117 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005118 * This is called as a scheduled work item (except for during intialization)
5119 */
5120static void ipw_rx_queue_replenish(void *data)
5121{
5122 struct ipw_priv *priv = data;
5123 struct ipw_rx_queue *rxq = priv->rxq;
5124 struct list_head *element;
5125 struct ipw_rx_mem_buffer *rxb;
5126 unsigned long flags;
5127
5128 spin_lock_irqsave(&rxq->lock, flags);
5129 while (!list_empty(&rxq->rx_used)) {
5130 element = rxq->rx_used.next;
5131 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005132 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005133 if (!rxb->skb) {
5134 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5135 priv->net_dev->name);
5136 /* We don't reschedule replenish work here -- we will
5137 * call the restock method and if it still needs
5138 * more buffers it will schedule replenish */
5139 break;
5140 }
5141 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005142
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005143 rxb->dma_addr =
5144 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005145 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005146
James Ketrenos43f66a62005-03-25 12:31:53 -06005147 list_add_tail(&rxb->list, &rxq->rx_free);
5148 rxq->free_count++;
5149 }
5150 spin_unlock_irqrestore(&rxq->lock, flags);
5151
5152 ipw_rx_queue_restock(priv);
5153}
5154
David Howellsc4028952006-11-22 14:57:56 +00005155static void ipw_bg_rx_queue_replenish(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005156{
David Howellsc4028952006-11-22 14:57:56 +00005157 struct ipw_priv *priv =
5158 container_of(work, struct ipw_priv, rx_replenish);
Zhu Yi46441512006-01-24 16:37:59 +08005159 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00005160 ipw_rx_queue_replenish(priv);
Zhu Yi46441512006-01-24 16:37:59 +08005161 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005162}
5163
James Ketrenos43f66a62005-03-25 12:31:53 -06005164/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005165 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005166 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005167 * non NULL it is unmapped and freed
5168 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005169static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005170{
5171 int i;
5172
5173 if (!rxq)
5174 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005175
James Ketrenos43f66a62005-03-25 12:31:53 -06005176 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5177 if (rxq->pool[i].skb != NULL) {
5178 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005179 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005180 dev_kfree_skb(rxq->pool[i].skb);
5181 }
5182 }
5183
5184 kfree(rxq);
5185}
5186
5187static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5188{
5189 struct ipw_rx_queue *rxq;
5190 int i;
5191
Takisc75f4742005-12-01 01:41:45 -08005192 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005193 if (unlikely(!rxq)) {
5194 IPW_ERROR("memory allocation failed\n");
5195 return NULL;
5196 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005197 spin_lock_init(&rxq->lock);
5198 INIT_LIST_HEAD(&rxq->rx_free);
5199 INIT_LIST_HEAD(&rxq->rx_used);
5200
5201 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005202 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005203 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5204
5205 /* Set us so that we have processed and used all buffers, but have
5206 * not restocked the Rx queue with fresh buffers */
5207 rxq->read = rxq->write = 0;
5208 rxq->processed = RX_QUEUE_SIZE - 1;
5209 rxq->free_count = 0;
5210
5211 return rxq;
5212}
5213
5214static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5215{
5216 rate &= ~IEEE80211_BASIC_RATE_MASK;
5217 if (ieee_mode == IEEE_A) {
5218 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005219 case IEEE80211_OFDM_RATE_6MB:
5220 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005221 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005222 case IEEE80211_OFDM_RATE_9MB:
5223 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005224 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005225 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005226 return priv->
5227 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005228 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005229 return priv->
5230 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005231 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005232 return priv->
5233 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005234 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005235 return priv->
5236 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005237 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005238 return priv->
5239 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005240 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005241 return priv->
5242 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005243 default:
5244 return 0;
5245 }
5246 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005247
James Ketrenos43f66a62005-03-25 12:31:53 -06005248 /* B and G mixed */
5249 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005250 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005251 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005252 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005253 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005254 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005255 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005256 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005257 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5258 }
5259
5260 /* If we are limited to B modulations, bail at this point */
5261 if (ieee_mode == IEEE_B)
5262 return 0;
5263
5264 /* G */
5265 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005266 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005267 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005268 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005269 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005270 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005271 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005272 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005273 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005274 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005275 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005276 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005277 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005278 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005279 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005280 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005281 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5282 }
5283
5284 return 0;
5285}
5286
Jeff Garzikbf794512005-07-31 13:07:26 -04005287static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005288 const struct ieee80211_network *network,
5289 struct ipw_supported_rates *rates)
5290{
5291 int num_rates, i;
5292
5293 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005294 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005295 rates->num_rates = 0;
5296 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005297 if (!ipw_is_rate_in_mask(priv, network->mode,
5298 network->rates[i])) {
5299
James Ketrenosea2b26e2005-08-24 21:25:16 -05005300 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005301 IPW_DEBUG_SCAN("Adding masked mandatory "
5302 "rate %02X\n",
5303 network->rates[i]);
5304 rates->supported_rates[rates->num_rates++] =
5305 network->rates[i];
5306 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005307 }
5308
James Ketrenos43f66a62005-03-25 12:31:53 -06005309 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5310 network->rates[i], priv->rates_mask);
5311 continue;
5312 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005313
James Ketrenos43f66a62005-03-25 12:31:53 -06005314 rates->supported_rates[rates->num_rates++] = network->rates[i];
5315 }
5316
James Ketrenosa613bff2005-08-24 21:43:11 -05005317 num_rates = min(network->rates_ex_len,
5318 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005319 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005320 if (!ipw_is_rate_in_mask(priv, network->mode,
5321 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005322 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005323 IPW_DEBUG_SCAN("Adding masked mandatory "
5324 "rate %02X\n",
5325 network->rates_ex[i]);
5326 rates->supported_rates[rates->num_rates++] =
5327 network->rates[i];
5328 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005329 }
5330
James Ketrenos43f66a62005-03-25 12:31:53 -06005331 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5332 network->rates_ex[i], priv->rates_mask);
5333 continue;
5334 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005335
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005336 rates->supported_rates[rates->num_rates++] =
5337 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005338 }
5339
James Ketrenosea2b26e2005-08-24 21:25:16 -05005340 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005341}
5342
Arjan van de Ven858119e2006-01-14 13:20:43 -08005343static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005344 const struct ipw_supported_rates *src)
5345{
5346 u8 i;
5347 for (i = 0; i < src->num_rates; i++)
5348 dest->supported_rates[i] = src->supported_rates[i];
5349 dest->num_rates = src->num_rates;
5350}
5351
5352/* TODO: Look at sniffed packets in the air to determine if the basic rate
5353 * mask should ever be used -- right now all callers to add the scan rates are
5354 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5355static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005356 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005357{
Jeff Garzikbf794512005-07-31 13:07:26 -04005358 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005359 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005360
James Ketrenos43f66a62005-03-25 12:31:53 -06005361 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005362 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005363 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005364
5365 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005366 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005367 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005368
5369 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005370 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005371 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005372
5373 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005374 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005375 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005376}
5377
5378static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005379 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005380{
Jeff Garzikbf794512005-07-31 13:07:26 -04005381 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005382 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005383
5384 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005385 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005386 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005387
5388 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005389 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005390 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005391
5392 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005393 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005394 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005395
5396 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005397 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005398 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005399
5400 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005401 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005402 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005403
5404 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005405 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005406 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005407
5408 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005409 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005410 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005411
5412 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005413 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005414 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005415}
5416
5417struct ipw_network_match {
5418 struct ieee80211_network *network;
5419 struct ipw_supported_rates rates;
5420};
5421
James Ketrenosc848d0a2005-08-24 21:56:24 -05005422static int ipw_find_adhoc_network(struct ipw_priv *priv,
5423 struct ipw_network_match *match,
5424 struct ieee80211_network *network,
5425 int roaming)
5426{
5427 struct ipw_supported_rates rates;
Joe Perches0795af52007-10-03 17:59:30 -07005428 DECLARE_MAC_BUF(mac);
5429 DECLARE_MAC_BUF(mac2);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005430
5431 /* Verify that this network's capability is compatible with the
5432 * current mode (AdHoc or Infrastructure) */
5433 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5434 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Joe Perches0795af52007-10-03 17:59:30 -07005435 IPW_DEBUG_MERGE("Network '%s (%s)' excluded due to "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005436 "capability mismatch.\n",
5437 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005438 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005439 return 0;
5440 }
5441
5442 /* If we do not have an ESSID for this AP, we can not associate with
5443 * it */
5444 if (network->flags & NETWORK_EMPTY_ESSID) {
Joe Perches0795af52007-10-03 17:59:30 -07005445 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005446 "because of hidden ESSID.\n",
5447 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005448 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005449 return 0;
5450 }
5451
5452 if (unlikely(roaming)) {
5453 /* If we are roaming, then ensure check if this is a valid
5454 * network to try and roam to */
5455 if ((network->ssid_len != match->network->ssid_len) ||
5456 memcmp(network->ssid, match->network->ssid,
5457 network->ssid_len)) {
Joe Perches0795af52007-10-03 17:59:30 -07005458 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005459 "because of non-network ESSID.\n",
5460 escape_essid(network->ssid,
5461 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005462 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005463 return 0;
5464 }
5465 } else {
5466 /* If an ESSID has been configured then compare the broadcast
5467 * ESSID to ours */
5468 if ((priv->config & CFG_STATIC_ESSID) &&
5469 ((network->ssid_len != priv->essid_len) ||
5470 memcmp(network->ssid, priv->essid,
5471 min(network->ssid_len, priv->essid_len)))) {
5472 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005473
James Ketrenosc848d0a2005-08-24 21:56:24 -05005474 strncpy(escaped,
5475 escape_essid(network->ssid, network->ssid_len),
5476 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005477 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005478 "because of ESSID mismatch: '%s'.\n",
Joe Perches0795af52007-10-03 17:59:30 -07005479 escaped, print_mac(mac, network->bssid),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005480 escape_essid(priv->essid,
5481 priv->essid_len));
5482 return 0;
5483 }
5484 }
5485
5486 /* If the old network rate is better than this one, don't bother
5487 * testing everything else. */
5488
5489 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005490 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5491 "current network.\n",
5492 escape_essid(match->network->ssid,
5493 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005494 return 0;
5495 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005496 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5497 "current network.\n",
5498 escape_essid(match->network->ssid,
5499 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005500 return 0;
5501 }
5502
5503 /* Now go through and see if the requested network is valid... */
5504 if (priv->ieee->scan_age != 0 &&
5505 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Joe Perches0795af52007-10-03 17:59:30 -07005506 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005507 "because of age: %ums.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005508 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005509 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005510 jiffies_to_msecs(jiffies -
5511 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005512 return 0;
5513 }
5514
5515 if ((priv->config & CFG_STATIC_CHANNEL) &&
5516 (network->channel != priv->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005517 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005518 "because of channel mismatch: %d != %d.\n",
5519 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005520 print_mac(mac, network->bssid),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005521 network->channel, priv->channel);
5522 return 0;
5523 }
5524
5525 /* Verify privacy compatability */
5526 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5527 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Joe Perches0795af52007-10-03 17:59:30 -07005528 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005529 "because of privacy mismatch: %s != %s.\n",
5530 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005531 print_mac(mac, network->bssid),
James Ketrenosafbf30a2005-08-25 00:05:33 -05005532 priv->
5533 capability & CAP_PRIVACY_ON ? "on" : "off",
5534 network->
5535 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5536 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005537 return 0;
5538 }
5539
5540 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Joe Perches0795af52007-10-03 17:59:30 -07005541 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
5542 "because of the same BSSID match: %s"
James Ketrenosc848d0a2005-08-24 21:56:24 -05005543 ".\n", escape_essid(network->ssid,
5544 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005545 print_mac(mac, network->bssid),
5546 print_mac(mac2, priv->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005547 return 0;
5548 }
5549
5550 /* Filter out any incompatible freq / mode combinations */
5551 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Joe Perches0795af52007-10-03 17:59:30 -07005552 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005553 "because of invalid frequency/mode "
5554 "combination.\n",
5555 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005556 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005557 return 0;
5558 }
5559
5560 /* Ensure that the rates supported by the driver are compatible with
5561 * this AP, including verification of basic rates (mandatory) */
5562 if (!ipw_compatible_rates(priv, network, &rates)) {
Joe Perches0795af52007-10-03 17:59:30 -07005563 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005564 "because configured rate mask excludes "
5565 "AP mandatory rate.\n",
5566 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005567 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005568 return 0;
5569 }
5570
5571 if (rates.num_rates == 0) {
Joe Perches0795af52007-10-03 17:59:30 -07005572 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005573 "because of no compatible rates.\n",
5574 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005575 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005576 return 0;
5577 }
5578
5579 /* TODO: Perform any further minimal comparititive tests. We do not
5580 * want to put too much policy logic here; intelligent scan selection
5581 * should occur within a generic IEEE 802.11 user space tool. */
5582
5583 /* Set up 'new' AP to this network */
5584 ipw_copy_rates(&match->rates, &rates);
5585 match->network = network;
Joe Perches0795af52007-10-03 17:59:30 -07005586 IPW_DEBUG_MERGE("Network '%s (%s)' is a viable match.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005587 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005588 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005589
5590 return 1;
5591}
5592
David Howellsc4028952006-11-22 14:57:56 +00005593static void ipw_merge_adhoc_network(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005594{
David Howellsc4028952006-11-22 14:57:56 +00005595 struct ipw_priv *priv =
5596 container_of(work, struct ipw_priv, merge_networks);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005597 struct ieee80211_network *network = NULL;
5598 struct ipw_network_match match = {
5599 .network = priv->assoc_network
5600 };
5601
James Ketrenosafbf30a2005-08-25 00:05:33 -05005602 if ((priv->status & STATUS_ASSOCIATED) &&
5603 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005604 /* First pass through ROAM process -- look for a better
5605 * network */
5606 unsigned long flags;
5607
5608 spin_lock_irqsave(&priv->ieee->lock, flags);
5609 list_for_each_entry(network, &priv->ieee->network_list, list) {
5610 if (network != priv->assoc_network)
5611 ipw_find_adhoc_network(priv, &match, network,
5612 1);
5613 }
5614 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5615
5616 if (match.network == priv->assoc_network) {
5617 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5618 "merge to.\n");
5619 return;
5620 }
5621
Zhu Yi46441512006-01-24 16:37:59 +08005622 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005623 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5624 IPW_DEBUG_MERGE("remove network %s\n",
5625 escape_essid(priv->essid,
5626 priv->essid_len));
5627 ipw_remove_current_network(priv);
5628 }
5629
5630 ipw_disassociate(priv);
5631 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005632 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005633 return;
5634 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005635}
5636
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005637static int ipw_best_network(struct ipw_priv *priv,
5638 struct ipw_network_match *match,
5639 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005640{
5641 struct ipw_supported_rates rates;
Joe Perches0795af52007-10-03 17:59:30 -07005642 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06005643
5644 /* Verify that this network's capability is compatible with the
5645 * current mode (AdHoc or Infrastructure) */
5646 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005647 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005648 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5649 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Joe Perches0795af52007-10-03 17:59:30 -07005650 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005651 "capability mismatch.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005652 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005653 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005654 return 0;
5655 }
5656
5657 /* If we do not have an ESSID for this AP, we can not associate with
5658 * it */
5659 if (network->flags & NETWORK_EMPTY_ESSID) {
Joe Perches0795af52007-10-03 17:59:30 -07005660 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005661 "because of hidden ESSID.\n",
5662 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005663 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005664 return 0;
5665 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005666
James Ketrenos43f66a62005-03-25 12:31:53 -06005667 if (unlikely(roaming)) {
5668 /* If we are roaming, then ensure check if this is a valid
5669 * network to try and roam to */
5670 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005671 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005672 network->ssid_len)) {
Joe Perches0795af52007-10-03 17:59:30 -07005673 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005674 "because of non-network ESSID.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04005675 escape_essid(network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005676 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005677 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005678 return 0;
5679 }
5680 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005681 /* If an ESSID has been configured then compare the broadcast
5682 * ESSID to ours */
5683 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005684 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005685 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005686 min(network->ssid_len, priv->essid_len)))) {
5687 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005688 strncpy(escaped,
5689 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005690 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005691 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005692 "because of ESSID mismatch: '%s'.\n",
Joe Perches0795af52007-10-03 17:59:30 -07005693 escaped, print_mac(mac, network->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005694 escape_essid(priv->essid,
5695 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005696 return 0;
5697 }
5698 }
5699
5700 /* If the old network rate is better than this one, don't bother
5701 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005702 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005703 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005704 strncpy(escaped,
5705 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005706 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005707 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded because "
5708 "'%s (%s)' has a stronger signal.\n",
5709 escaped, print_mac(mac, network->bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06005710 escape_essid(match->network->ssid,
5711 match->network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005712 print_mac(mac, match->network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005713 return 0;
5714 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005715
James Ketrenos43f66a62005-03-25 12:31:53 -06005716 /* If this network has already had an association attempt within the
5717 * last 3 seconds, do not try and associate again... */
5718 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005719 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
Joe Perches0795af52007-10-03 17:59:30 -07005720 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005721 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005722 "assoc attempt).\n",
5723 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005724 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005725 jiffies_to_msecs(jiffies -
5726 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005727 return 0;
5728 }
5729
5730 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005731 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005732 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Joe Perches0795af52007-10-03 17:59:30 -07005733 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005734 "because of age: %ums.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005735 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005736 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005737 jiffies_to_msecs(jiffies -
5738 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005739 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005740 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005741
Jeff Garzikbf794512005-07-31 13:07:26 -04005742 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005743 (network->channel != priv->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005744 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005745 "because of channel mismatch: %d != %d.\n",
5746 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005747 print_mac(mac, network->bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06005748 network->channel, priv->channel);
5749 return 0;
5750 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005751
James Ketrenos43f66a62005-03-25 12:31:53 -06005752 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005753 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005754 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Joe Perches0795af52007-10-03 17:59:30 -07005755 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005756 "because of privacy mismatch: %s != %s.\n",
5757 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005758 print_mac(mac, network->bssid),
Jeff Garzikbf794512005-07-31 13:07:26 -04005759 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005760 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005761 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005762 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005763 return 0;
5764 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005765
5766 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005767 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Joe Perches0795af52007-10-03 17:59:30 -07005768 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
5769 "because of BSSID mismatch: %s.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005770 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005771 print_mac(mac, network->bssid), print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005772 return 0;
5773 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005774
James Ketrenos43f66a62005-03-25 12:31:53 -06005775 /* Filter out any incompatible freq / mode combinations */
5776 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Joe Perches0795af52007-10-03 17:59:30 -07005777 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005778 "because of invalid frequency/mode "
5779 "combination.\n",
5780 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005781 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005782 return 0;
5783 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005784
Liu Hong1fe0adb2005-08-19 09:33:10 -05005785 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005786 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005787 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Liu Hong1fe0adb2005-08-19 09:33:10 -05005788 "because of invalid channel in current GEO\n",
5789 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005790 print_mac(mac, network->bssid));
Liu Hong1fe0adb2005-08-19 09:33:10 -05005791 return 0;
5792 }
5793
James Ketrenosea2b26e2005-08-24 21:25:16 -05005794 /* Ensure that the rates supported by the driver are compatible with
5795 * this AP, including verification of basic rates (mandatory) */
5796 if (!ipw_compatible_rates(priv, network, &rates)) {
Joe Perches0795af52007-10-03 17:59:30 -07005797 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenosea2b26e2005-08-24 21:25:16 -05005798 "because configured rate mask excludes "
5799 "AP mandatory rate.\n",
5800 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005801 print_mac(mac, network->bssid));
James Ketrenosea2b26e2005-08-24 21:25:16 -05005802 return 0;
5803 }
5804
James Ketrenos43f66a62005-03-25 12:31:53 -06005805 if (rates.num_rates == 0) {
Joe Perches0795af52007-10-03 17:59:30 -07005806 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005807 "because of no compatible rates.\n",
5808 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005809 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005810 return 0;
5811 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005812
James Ketrenos43f66a62005-03-25 12:31:53 -06005813 /* TODO: Perform any further minimal comparititive tests. We do not
5814 * want to put too much policy logic here; intelligent scan selection
5815 * should occur within a generic IEEE 802.11 user space tool. */
5816
5817 /* Set up 'new' AP to this network */
5818 ipw_copy_rates(&match->rates, &rates);
5819 match->network = network;
5820
Joe Perches0795af52007-10-03 17:59:30 -07005821 IPW_DEBUG_ASSOC("Network '%s (%s)' is a viable match.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005822 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005823 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005824
5825 return 1;
5826}
5827
Jeff Garzikbf794512005-07-31 13:07:26 -04005828static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005829 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005830{
Larry Finger1867b112006-02-28 09:48:28 -06005831 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005832 int i;
5833
James Ketrenos43f66a62005-03-25 12:31:53 -06005834 /*
5835 * For the purposes of scanning, we can set our wireless mode
5836 * to trigger scans across combinations of bands, but when it
5837 * comes to creating a new ad-hoc network, we have tell the FW
5838 * exactly which band to use.
5839 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005840 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005841 * chossen band. Attempting to create a new ad-hoc network
5842 * with an invalid channel for wireless mode will trigger a
5843 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005844 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005845 */
Larry Finger1867b112006-02-28 09:48:28 -06005846 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005847 case IEEE80211_52GHZ_BAND:
5848 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005849 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005850 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005851 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5852 IPW_WARNING("Overriding invalid channel\n");
5853 priv->channel = geo->a[0].channel;
5854 }
5855 break;
5856
5857 case IEEE80211_24GHZ_BAND:
5858 if (priv->ieee->mode & IEEE_G)
5859 network->mode = IEEE_G;
5860 else
5861 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005862 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005863 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005864 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5865 IPW_WARNING("Overriding invalid channel\n");
5866 priv->channel = geo->bg[0].channel;
5867 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005868 break;
5869
5870 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005871 IPW_WARNING("Overriding invalid channel\n");
5872 if (priv->ieee->mode & IEEE_A) {
5873 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005874 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005875 } else if (priv->ieee->mode & IEEE_G) {
5876 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005877 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005878 } else {
5879 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005880 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005881 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005882 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005883 }
5884
5885 network->channel = priv->channel;
5886 priv->config |= CFG_ADHOC_PERSIST;
5887 ipw_create_bssid(priv, network->bssid);
5888 network->ssid_len = priv->essid_len;
5889 memcpy(network->ssid, priv->essid, priv->essid_len);
5890 memset(&network->stats, 0, sizeof(network->stats));
5891 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005892 if (!(priv->config & CFG_PREAMBLE_LONG))
5893 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005894 if (priv->capability & CAP_PRIVACY_ON)
5895 network->capability |= WLAN_CAPABILITY_PRIVACY;
5896 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005897 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005898 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005899 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005900 &priv->rates.supported_rates[network->rates_len],
5901 network->rates_ex_len);
5902 network->last_scanned = 0;
5903 network->flags = 0;
5904 network->last_associate = 0;
5905 network->time_stamp[0] = 0;
5906 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005907 network->beacon_interval = 100; /* Default */
5908 network->listen_interval = 10; /* Default */
5909 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005910 network->wpa_ie_len = 0;
5911 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005912}
5913
James Ketrenosb095c382005-08-24 22:04:42 -05005914static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5915{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005916 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005917
5918 if (!(priv->ieee->sec.flags & (1 << index)))
5919 return;
5920
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005921 key.key_id = index;
5922 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5923 key.security_type = type;
5924 key.station_index = 0; /* always 0 for BSS */
5925 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005926 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005927 key.tx_counter[0] = cpu_to_le32(0);
5928 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005929
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005930 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005931}
5932
5933static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005934{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005935 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005936 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005937
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005938 key.cmd_id = DINO_CMD_WEP_KEY;
5939 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005940
James Ketrenosb095c382005-08-24 22:04:42 -05005941 /* Note: AES keys cannot be set for multiple times.
5942 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005943 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005944 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005945 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005946 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005947 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005948 }
5949
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005950 key.key_size = priv->ieee->sec.key_sizes[i];
5951 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005952
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005953 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005954 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005955}
5956
Zhu Yi1fbfea52005-08-05 17:22:56 +08005957static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5958{
5959 if (priv->ieee->host_encrypt)
5960 return;
5961
5962 switch (level) {
5963 case SEC_LEVEL_3:
5964 priv->sys_config.disable_unicast_decryption = 0;
5965 priv->ieee->host_decrypt = 0;
5966 break;
5967 case SEC_LEVEL_2:
5968 priv->sys_config.disable_unicast_decryption = 1;
5969 priv->ieee->host_decrypt = 1;
5970 break;
5971 case SEC_LEVEL_1:
5972 priv->sys_config.disable_unicast_decryption = 0;
5973 priv->ieee->host_decrypt = 0;
5974 break;
5975 case SEC_LEVEL_0:
5976 priv->sys_config.disable_unicast_decryption = 1;
5977 break;
5978 default:
5979 break;
5980 }
5981}
5982
5983static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5984{
5985 if (priv->ieee->host_encrypt)
5986 return;
5987
5988 switch (level) {
5989 case SEC_LEVEL_3:
5990 priv->sys_config.disable_multicast_decryption = 0;
5991 break;
5992 case SEC_LEVEL_2:
5993 priv->sys_config.disable_multicast_decryption = 1;
5994 break;
5995 case SEC_LEVEL_1:
5996 priv->sys_config.disable_multicast_decryption = 0;
5997 break;
5998 case SEC_LEVEL_0:
5999 priv->sys_config.disable_multicast_decryption = 1;
6000 break;
6001 default:
6002 break;
6003 }
6004}
6005
James Ketrenosb095c382005-08-24 22:04:42 -05006006static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
6007{
6008 switch (priv->ieee->sec.level) {
6009 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006010 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6011 ipw_send_tgi_tx_key(priv,
6012 DCT_FLAG_EXT_SECURITY_CCM,
6013 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006014
Hong Liu567deaf2005-08-31 18:07:22 +08006015 if (!priv->ieee->host_mc_decrypt)
6016 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05006017 break;
6018 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006019 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6020 ipw_send_tgi_tx_key(priv,
6021 DCT_FLAG_EXT_SECURITY_TKIP,
6022 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05006023 break;
6024 case SEC_LEVEL_1:
6025 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05006026 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
6027 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05006028 break;
6029 case SEC_LEVEL_0:
6030 default:
6031 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06006032 }
6033}
6034
6035static void ipw_adhoc_check(void *data)
6036{
6037 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04006038
James Ketrenosafbf30a2005-08-25 00:05:33 -05006039 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06006040 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006041 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
6042 IPW_DL_STATE | IPW_DL_ASSOC,
6043 "Missed beacon: %d - disassociate\n",
6044 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06006045 ipw_remove_current_network(priv);
6046 ipw_disassociate(priv);
6047 return;
6048 }
6049
Jeff Garzikbf794512005-07-31 13:07:26 -04006050 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
James Ketrenos43f66a62005-03-25 12:31:53 -06006051 priv->assoc_request.beacon_interval);
6052}
6053
David Howellsc4028952006-11-22 14:57:56 +00006054static void ipw_bg_adhoc_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006055{
David Howellsc4028952006-11-22 14:57:56 +00006056 struct ipw_priv *priv =
6057 container_of(work, struct ipw_priv, adhoc_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08006058 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006059 ipw_adhoc_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006060 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006061}
6062
James Ketrenos43f66a62005-03-25 12:31:53 -06006063static void ipw_debug_config(struct ipw_priv *priv)
6064{
Joe Perches0795af52007-10-03 17:59:30 -07006065 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06006066 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
6067 "[CFG 0x%08X]\n", priv->config);
6068 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006069 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06006070 else
6071 IPW_DEBUG_INFO("Channel unlocked.\n");
6072 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04006073 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006074 escape_essid(priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06006075 else
6076 IPW_DEBUG_INFO("ESSID unlocked.\n");
6077 if (priv->config & CFG_STATIC_BSSID)
Joe Perches0795af52007-10-03 17:59:30 -07006078 IPW_DEBUG_INFO("BSSID locked to %s\n",
6079 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06006080 else
6081 IPW_DEBUG_INFO("BSSID unlocked.\n");
6082 if (priv->capability & CAP_PRIVACY_ON)
6083 IPW_DEBUG_INFO("PRIVACY on\n");
6084 else
6085 IPW_DEBUG_INFO("PRIVACY off\n");
6086 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
6087}
James Ketrenos43f66a62005-03-25 12:31:53 -06006088
Arjan van de Ven858119e2006-01-14 13:20:43 -08006089static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06006090{
6091 /* TODO: Verify that this works... */
6092 struct ipw_fixed_rate fr = {
6093 .tx_rates = priv->rates_mask
6094 };
6095 u32 reg;
6096 u16 mask = 0;
6097
Jeff Garzikbf794512005-07-31 13:07:26 -04006098 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06006099 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04006100
James Ketrenos43f66a62005-03-25 12:31:53 -06006101 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006102 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06006103 /* IEEE_A */
6104 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6105 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006106 IPW_DEBUG_WX
6107 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006108 fr.tx_rates = 0;
6109 break;
6110 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006111
James Ketrenos43f66a62005-03-25 12:31:53 -06006112 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6113 break;
6114
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006115 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006116 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006117 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006118 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6119 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006120 IPW_DEBUG_WX
6121 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006122 fr.tx_rates = 0;
6123 }
6124 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006125 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006126
6127 /* IEEE_G */
6128 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6129 IEEE80211_OFDM_RATES_MASK)) {
6130 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006131 IPW_DEBUG_WX
6132 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006133 fr.tx_rates = 0;
6134 break;
6135 }
6136
6137 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6138 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6139 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6140 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006141
James Ketrenos43f66a62005-03-25 12:31:53 -06006142 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6143 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6144 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6145 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006146
James Ketrenos43f66a62005-03-25 12:31:53 -06006147 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6148 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6149 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6150 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006151
James Ketrenos43f66a62005-03-25 12:31:53 -06006152 fr.tx_rates |= mask;
6153 break;
6154 }
6155
6156 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006157 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006158}
6159
James Ketrenosea2b26e2005-08-24 21:25:16 -05006160static void ipw_abort_scan(struct ipw_priv *priv)
6161{
6162 int err;
6163
6164 if (priv->status & STATUS_SCAN_ABORTING) {
6165 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6166 return;
6167 }
6168 priv->status |= STATUS_SCAN_ABORTING;
6169
6170 err = ipw_send_scan_abort(priv);
6171 if (err)
6172 IPW_DEBUG_HC("Request to abort scan failed.\n");
6173}
6174
James Ketrenosafbf30a2005-08-25 00:05:33 -05006175static void ipw_add_scan_channels(struct ipw_priv *priv,
6176 struct ipw_scan_request_ext *scan,
6177 int scan_type)
6178{
6179 int channel_index = 0;
6180 const struct ieee80211_geo *geo;
6181 int i;
6182
Larry Finger1867b112006-02-28 09:48:28 -06006183 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006184
6185 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6186 int start = channel_index;
6187 for (i = 0; i < geo->a_channels; i++) {
6188 if ((priv->status & STATUS_ASSOCIATED) &&
6189 geo->a[i].channel == priv->channel)
6190 continue;
6191 channel_index++;
6192 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006193 ipw_set_scan_type(scan, channel_index,
6194 geo->a[i].
6195 flags & IEEE80211_CH_PASSIVE_ONLY ?
6196 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6197 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006198 }
6199
6200 if (start != channel_index) {
6201 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6202 (channel_index - start);
6203 channel_index++;
6204 }
6205 }
6206
6207 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6208 int start = channel_index;
6209 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006210 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006211 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6212 /* nop out the list */
6213 [0] = 0
6214 };
6215
6216 u8 channel;
6217 while (channel_index < IPW_SCAN_CHANNELS) {
6218 channel =
6219 priv->speed_scan[priv->speed_scan_pos];
6220 if (channel == 0) {
6221 priv->speed_scan_pos = 0;
6222 channel = priv->speed_scan[0];
6223 }
6224 if ((priv->status & STATUS_ASSOCIATED) &&
6225 channel == priv->channel) {
6226 priv->speed_scan_pos++;
6227 continue;
6228 }
6229
6230 /* If this channel has already been
6231 * added in scan, break from loop
6232 * and this will be the first channel
6233 * in the next scan.
6234 */
6235 if (channels[channel - 1] != 0)
6236 break;
6237
6238 channels[channel - 1] = 1;
6239 priv->speed_scan_pos++;
6240 channel_index++;
6241 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006242 index =
Larry Finger1867b112006-02-28 09:48:28 -06006243 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006244 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006245 geo->bg[index].
6246 flags &
6247 IEEE80211_CH_PASSIVE_ONLY ?
6248 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6249 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006250 }
6251 } else {
6252 for (i = 0; i < geo->bg_channels; i++) {
6253 if ((priv->status & STATUS_ASSOCIATED) &&
6254 geo->bg[i].channel == priv->channel)
6255 continue;
6256 channel_index++;
6257 scan->channels_list[channel_index] =
6258 geo->bg[i].channel;
6259 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006260 geo->bg[i].
6261 flags &
6262 IEEE80211_CH_PASSIVE_ONLY ?
6263 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6264 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006265 }
6266 }
6267
6268 if (start != channel_index) {
6269 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6270 (channel_index - start);
6271 }
6272 }
6273}
6274
Zhu Yi094c4d22006-08-21 11:39:03 +08006275static int ipw_request_scan_helper(struct ipw_priv *priv, int type)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006276{
6277 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006278 int err = 0, scan_type;
6279
6280 if (!(priv->status & STATUS_INIT) ||
6281 (priv->status & STATUS_EXIT_PENDING))
6282 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006283
Zhu Yi46441512006-01-24 16:37:59 +08006284 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006285
James Ketrenosea2b26e2005-08-24 21:25:16 -05006286 if (priv->status & STATUS_SCANNING) {
James Ketrenosa613bff2005-08-24 21:43:11 -05006287 IPW_DEBUG_HC("Concurrent scan requested. Ignoring.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05006288 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006289 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006290 }
6291
James Ketrenosafbf30a2005-08-25 00:05:33 -05006292 if (!(priv->status & STATUS_SCAN_FORCED) &&
6293 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006294 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
6295 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006296 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006297 }
6298
6299 if (priv->status & STATUS_RF_KILL_MASK) {
6300 IPW_DEBUG_HC("Aborting scan due to RF Kill activation\n");
6301 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006302 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006303 }
6304
6305 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006306 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006307
Zhu Yi094c4d22006-08-21 11:39:03 +08006308 if (type == IW_SCAN_TYPE_PASSIVE) {
6309 IPW_DEBUG_WX("use passive scanning\n");
6310 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
6311 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6312 cpu_to_le16(120);
6313 ipw_add_scan_channels(priv, &scan, scan_type);
6314 goto send_request;
6315 }
6316
6317 /* Use active scan by default. */
6318 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006319 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006320 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006321 else
6322 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006323 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006324
James Ketrenosa613bff2005-08-24 21:43:11 -05006325 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006326 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006327
Zhu Yi094c4d22006-08-21 11:39:03 +08006328 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006329
James Ketrenosb095c382005-08-24 22:04:42 -05006330#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006331 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006332 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006333 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006334
Larry Finger1867b112006-02-28 09:48:28 -06006335 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006336 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006337 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006338 channel = priv->channel;
6339 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006340
James Ketrenosb095c382005-08-24 22:04:42 -05006341 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006342 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006343 channel = priv->channel;
6344 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006345
James Ketrenosb095c382005-08-24 22:04:42 -05006346 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006347 band = (u8) (IPW_B_MODE << 6) | 1;
6348 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006349 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006350 }
6351
James Ketrenosb095c382005-08-24 22:04:42 -05006352 scan.channels_list[0] = band;
6353 scan.channels_list[1] = channel;
6354 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006355
James Ketrenosb095c382005-08-24 22:04:42 -05006356 /* NOTE: The card will sit on this channel for this time
6357 * period. Scan aborts are timing sensitive and frequently
6358 * result in firmware restarts. As such, it is best to
6359 * set a small dwell_time here and just keep re-issuing
6360 * scans. Otherwise fast channel hopping will not actually
6361 * hop channels.
6362 *
6363 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006364 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006365 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006366 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006367#endif /* CONFIG_IPW2200_MONITOR */
6368 /* If we are roaming, then make this a directed scan for the
6369 * current network. Otherwise, ensure that every other scan
6370 * is a fast channel hop scan */
6371 if ((priv->status & STATUS_ROAMING)
6372 || (!(priv->status & STATUS_ASSOCIATED)
6373 && (priv->config & CFG_STATIC_ESSID)
6374 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006375 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6376 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006377 IPW_DEBUG_HC("Attempt to send SSID command "
6378 "failed.\n");
6379 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006380 }
6381
6382 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006383 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006384 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006385
James Ketrenosafbf30a2005-08-25 00:05:33 -05006386 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006387#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006388 }
6389#endif
6390
Zhu Yi094c4d22006-08-21 11:39:03 +08006391send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006392 err = ipw_send_scan_request_ext(priv, &scan);
6393 if (err) {
6394 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006395 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006396 }
6397
6398 priv->status |= STATUS_SCANNING;
6399 priv->status &= ~STATUS_SCAN_PENDING;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006400 queue_delayed_work(priv->workqueue, &priv->scan_check,
6401 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006402done:
Zhu Yi46441512006-01-24 16:37:59 +08006403 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006404 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006405}
6406
David Howellsc4028952006-11-22 14:57:56 +00006407static void ipw_request_passive_scan(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006408{
David Howellsc4028952006-11-22 14:57:56 +00006409 struct ipw_priv *priv =
6410 container_of(work, struct ipw_priv, request_passive_scan);
6411 ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE);
6412}
6413
6414static void ipw_request_scan(struct work_struct *work)
6415{
6416 struct ipw_priv *priv =
6417 container_of(work, struct ipw_priv, request_scan.work);
6418 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE);
6419}
6420
6421static void ipw_bg_abort_scan(struct work_struct *work)
6422{
6423 struct ipw_priv *priv =
6424 container_of(work, struct ipw_priv, abort_scan);
Zhu Yi46441512006-01-24 16:37:59 +08006425 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006426 ipw_abort_scan(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006427 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006428}
6429
James Ketrenosea2b26e2005-08-24 21:25:16 -05006430static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6431{
James Ketrenosb095c382005-08-24 22:04:42 -05006432 /* This is called when wpa_supplicant loads and closes the driver
6433 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006434 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006435 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006436}
6437
James Ketrenosea2b26e2005-08-24 21:25:16 -05006438static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6439{
6440 struct ieee80211_device *ieee = priv->ieee;
6441 struct ieee80211_security sec = {
6442 .flags = SEC_AUTH_MODE,
6443 };
6444 int ret = 0;
6445
James Ketrenosafbf30a2005-08-25 00:05:33 -05006446 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006447 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6448 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006449 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006450 sec.auth_mode = WLAN_AUTH_OPEN;
6451 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006452 } else if (value & IW_AUTH_ALG_LEAP) {
6453 sec.auth_mode = WLAN_AUTH_LEAP;
6454 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006455 } else
6456 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006457
6458 if (ieee->set_security)
6459 ieee->set_security(ieee->dev, &sec);
6460 else
6461 ret = -EOPNOTSUPP;
6462
6463 return ret;
6464}
6465
Adrian Bunka73e22b2006-01-21 01:39:42 +01006466static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6467 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006468{
6469 /* make sure WPA is enabled */
6470 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006471}
6472
6473static int ipw_set_rsn_capa(struct ipw_priv *priv,
6474 char *capabilities, int length)
6475{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006476 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6477
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006478 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006479 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006480}
6481
James Ketrenosafbf30a2005-08-25 00:05:33 -05006482/*
6483 * WE-18 support
6484 */
6485
6486/* SIOCSIWGENIE */
6487static int ipw_wx_set_genie(struct net_device *dev,
6488 struct iw_request_info *info,
6489 union iwreq_data *wrqu, char *extra)
6490{
6491 struct ipw_priv *priv = ieee80211_priv(dev);
6492 struct ieee80211_device *ieee = priv->ieee;
6493 u8 *buf;
6494 int err = 0;
6495
6496 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6497 (wrqu->data.length && extra == NULL))
6498 return -EINVAL;
6499
James Ketrenosafbf30a2005-08-25 00:05:33 -05006500 if (wrqu->data.length) {
6501 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6502 if (buf == NULL) {
6503 err = -ENOMEM;
6504 goto out;
6505 }
6506
6507 memcpy(buf, extra, wrqu->data.length);
6508 kfree(ieee->wpa_ie);
6509 ieee->wpa_ie = buf;
6510 ieee->wpa_ie_len = wrqu->data.length;
6511 } else {
6512 kfree(ieee->wpa_ie);
6513 ieee->wpa_ie = NULL;
6514 ieee->wpa_ie_len = 0;
6515 }
6516
6517 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6518 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006519 return err;
6520}
6521
6522/* SIOCGIWGENIE */
6523static int ipw_wx_get_genie(struct net_device *dev,
6524 struct iw_request_info *info,
6525 union iwreq_data *wrqu, char *extra)
6526{
6527 struct ipw_priv *priv = ieee80211_priv(dev);
6528 struct ieee80211_device *ieee = priv->ieee;
6529 int err = 0;
6530
James Ketrenosafbf30a2005-08-25 00:05:33 -05006531 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6532 wrqu->data.length = 0;
6533 goto out;
6534 }
6535
6536 if (wrqu->data.length < ieee->wpa_ie_len) {
6537 err = -E2BIG;
6538 goto out;
6539 }
6540
6541 wrqu->data.length = ieee->wpa_ie_len;
6542 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6543
6544 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006545 return err;
6546}
6547
Zhu Yi1fbfea52005-08-05 17:22:56 +08006548static int wext_cipher2level(int cipher)
6549{
6550 switch (cipher) {
6551 case IW_AUTH_CIPHER_NONE:
6552 return SEC_LEVEL_0;
6553 case IW_AUTH_CIPHER_WEP40:
6554 case IW_AUTH_CIPHER_WEP104:
6555 return SEC_LEVEL_1;
6556 case IW_AUTH_CIPHER_TKIP:
6557 return SEC_LEVEL_2;
6558 case IW_AUTH_CIPHER_CCMP:
6559 return SEC_LEVEL_3;
6560 default:
6561 return -1;
6562 }
6563}
6564
James Ketrenosafbf30a2005-08-25 00:05:33 -05006565/* SIOCSIWAUTH */
6566static int ipw_wx_set_auth(struct net_device *dev,
6567 struct iw_request_info *info,
6568 union iwreq_data *wrqu, char *extra)
6569{
6570 struct ipw_priv *priv = ieee80211_priv(dev);
6571 struct ieee80211_device *ieee = priv->ieee;
6572 struct iw_param *param = &wrqu->param;
6573 struct ieee80211_crypt_data *crypt;
6574 unsigned long flags;
6575 int ret = 0;
6576
6577 switch (param->flags & IW_AUTH_INDEX) {
6578 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006579 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006580 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006581 ipw_set_hw_decrypt_unicast(priv,
6582 wext_cipher2level(param->value));
6583 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006584 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006585 ipw_set_hw_decrypt_multicast(priv,
6586 wext_cipher2level(param->value));
6587 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006588 case IW_AUTH_KEY_MGMT:
6589 /*
6590 * ipw2200 does not use these parameters
6591 */
6592 break;
6593
6594 case IW_AUTH_TKIP_COUNTERMEASURES:
6595 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006596 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006597 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006598
6599 flags = crypt->ops->get_flags(crypt->priv);
6600
6601 if (param->value)
6602 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6603 else
6604 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6605
6606 crypt->ops->set_flags(flags, crypt->priv);
6607
6608 break;
6609
6610 case IW_AUTH_DROP_UNENCRYPTED:{
6611 /* HACK:
6612 *
6613 * wpa_supplicant calls set_wpa_enabled when the driver
6614 * is loaded and unloaded, regardless of if WPA is being
6615 * used. No other calls are made which can be used to
6616 * determine if encryption will be used or not prior to
6617 * association being expected. If encryption is not being
6618 * used, drop_unencrypted is set to false, else true -- we
6619 * can use this to determine if the CAP_PRIVACY_ON bit should
6620 * be set.
6621 */
6622 struct ieee80211_security sec = {
6623 .flags = SEC_ENABLED,
6624 .enabled = param->value,
6625 };
6626 priv->ieee->drop_unencrypted = param->value;
6627 /* We only change SEC_LEVEL for open mode. Others
6628 * are set by ipw_wpa_set_encryption.
6629 */
6630 if (!param->value) {
6631 sec.flags |= SEC_LEVEL;
6632 sec.level = SEC_LEVEL_0;
6633 } else {
6634 sec.flags |= SEC_LEVEL;
6635 sec.level = SEC_LEVEL_1;
6636 }
6637 if (priv->ieee->set_security)
6638 priv->ieee->set_security(priv->ieee->dev, &sec);
6639 break;
6640 }
6641
6642 case IW_AUTH_80211_AUTH_ALG:
6643 ret = ipw_wpa_set_auth_algs(priv, param->value);
6644 break;
6645
6646 case IW_AUTH_WPA_ENABLED:
6647 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006648 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006649 break;
6650
6651 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6652 ieee->ieee802_1x = param->value;
6653 break;
6654
James Ketrenosafbf30a2005-08-25 00:05:33 -05006655 case IW_AUTH_PRIVACY_INVOKED:
6656 ieee->privacy_invoked = param->value;
6657 break;
6658
6659 default:
6660 return -EOPNOTSUPP;
6661 }
6662 return ret;
6663}
6664
6665/* SIOCGIWAUTH */
6666static int ipw_wx_get_auth(struct net_device *dev,
6667 struct iw_request_info *info,
6668 union iwreq_data *wrqu, char *extra)
6669{
6670 struct ipw_priv *priv = ieee80211_priv(dev);
6671 struct ieee80211_device *ieee = priv->ieee;
6672 struct ieee80211_crypt_data *crypt;
6673 struct iw_param *param = &wrqu->param;
6674 int ret = 0;
6675
6676 switch (param->flags & IW_AUTH_INDEX) {
6677 case IW_AUTH_WPA_VERSION:
6678 case IW_AUTH_CIPHER_PAIRWISE:
6679 case IW_AUTH_CIPHER_GROUP:
6680 case IW_AUTH_KEY_MGMT:
6681 /*
6682 * wpa_supplicant will control these internally
6683 */
6684 ret = -EOPNOTSUPP;
6685 break;
6686
6687 case IW_AUTH_TKIP_COUNTERMEASURES:
6688 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006689 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006690 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006691
6692 param->value = (crypt->ops->get_flags(crypt->priv) &
6693 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6694
6695 break;
6696
6697 case IW_AUTH_DROP_UNENCRYPTED:
6698 param->value = ieee->drop_unencrypted;
6699 break;
6700
6701 case IW_AUTH_80211_AUTH_ALG:
6702 param->value = ieee->sec.auth_mode;
6703 break;
6704
6705 case IW_AUTH_WPA_ENABLED:
6706 param->value = ieee->wpa_enabled;
6707 break;
6708
6709 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6710 param->value = ieee->ieee802_1x;
6711 break;
6712
6713 case IW_AUTH_ROAMING_CONTROL:
6714 case IW_AUTH_PRIVACY_INVOKED:
6715 param->value = ieee->privacy_invoked;
6716 break;
6717
6718 default:
6719 return -EOPNOTSUPP;
6720 }
6721 return 0;
6722}
6723
6724/* SIOCSIWENCODEEXT */
6725static int ipw_wx_set_encodeext(struct net_device *dev,
6726 struct iw_request_info *info,
6727 union iwreq_data *wrqu, char *extra)
6728{
6729 struct ipw_priv *priv = ieee80211_priv(dev);
6730 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6731
6732 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006733 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006734 /* IPW HW can't build TKIP MIC,
6735 host decryption still needed */
6736 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6737 priv->ieee->host_mc_decrypt = 1;
6738 else {
6739 priv->ieee->host_encrypt = 0;
6740 priv->ieee->host_encrypt_msdu = 1;
6741 priv->ieee->host_decrypt = 1;
6742 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006743 } else {
6744 priv->ieee->host_encrypt = 0;
6745 priv->ieee->host_encrypt_msdu = 0;
6746 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006747 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006748 }
6749 }
6750
6751 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6752}
6753
6754/* SIOCGIWENCODEEXT */
6755static int ipw_wx_get_encodeext(struct net_device *dev,
6756 struct iw_request_info *info,
6757 union iwreq_data *wrqu, char *extra)
6758{
6759 struct ipw_priv *priv = ieee80211_priv(dev);
6760 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6761}
6762
6763/* SIOCSIWMLME */
6764static int ipw_wx_set_mlme(struct net_device *dev,
6765 struct iw_request_info *info,
6766 union iwreq_data *wrqu, char *extra)
6767{
6768 struct ipw_priv *priv = ieee80211_priv(dev);
6769 struct iw_mlme *mlme = (struct iw_mlme *)extra;
6770 u16 reason;
6771
6772 reason = cpu_to_le16(mlme->reason_code);
6773
6774 switch (mlme->cmd) {
6775 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006776 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006777 break;
6778
6779 case IW_MLME_DISASSOC:
6780 ipw_disassociate(priv);
6781 break;
6782
6783 default:
6784 return -EOPNOTSUPP;
6785 }
6786 return 0;
6787}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006788
Zhu Yie43e3c12006-04-13 17:20:45 +08006789#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006790
6791/* QoS */
6792/*
6793* get the modulation type of the current network or
6794* the card current mode
6795*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006796static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006797{
6798 u8 mode = 0;
6799
6800 if (priv->status & STATUS_ASSOCIATED) {
6801 unsigned long flags;
6802
6803 spin_lock_irqsave(&priv->ieee->lock, flags);
6804 mode = priv->assoc_network->mode;
6805 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6806 } else {
6807 mode = priv->ieee->mode;
6808 }
6809 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6810 return mode;
6811}
6812
6813/*
6814* Handle management frame beacon and probe response
6815*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006816static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6817 int active_network,
6818 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006819{
6820 u32 size = sizeof(struct ieee80211_qos_parameters);
6821
James Ketrenosafbf30a2005-08-25 00:05:33 -05006822 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006823 network->qos_data.active = network->qos_data.supported;
6824
6825 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006826 if (active_network &&
6827 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006828 network->qos_data.active = network->qos_data.supported;
6829
6830 if ((network->qos_data.active == 1) && (active_network == 1) &&
6831 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6832 (network->qos_data.old_param_count !=
6833 network->qos_data.param_count)) {
6834 network->qos_data.old_param_count =
6835 network->qos_data.param_count;
6836 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006837 IPW_DEBUG_QOS("QoS parameters change call "
6838 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006839 }
6840 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006841 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6842 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006843 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006844 else
6845 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006846 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006847
James Ketrenosb095c382005-08-24 22:04:42 -05006848 if ((network->qos_data.active == 1) && (active_network == 1)) {
6849 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6850 schedule_work(&priv->qos_activate);
6851 }
6852
6853 network->qos_data.active = 0;
6854 network->qos_data.supported = 0;
6855 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006856 if ((priv->status & STATUS_ASSOCIATED) &&
6857 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6858 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
6859 if ((network->capability & WLAN_CAPABILITY_IBSS) &&
6860 !(network->flags & NETWORK_EMPTY_ESSID))
James Ketrenosb095c382005-08-24 22:04:42 -05006861 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006862 priv->assoc_network->ssid_len) &&
6863 !memcmp(network->ssid,
6864 priv->assoc_network->ssid,
6865 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006866 queue_work(priv->workqueue,
6867 &priv->merge_networks);
6868 }
James Ketrenosb095c382005-08-24 22:04:42 -05006869 }
6870
6871 return 0;
6872}
6873
6874/*
6875* This function set up the firmware to support QoS. It sends
6876* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6877*/
6878static int ipw_qos_activate(struct ipw_priv *priv,
6879 struct ieee80211_qos_data *qos_network_data)
6880{
6881 int err;
6882 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6883 struct ieee80211_qos_parameters *active_one = NULL;
6884 u32 size = sizeof(struct ieee80211_qos_parameters);
6885 u32 burst_duration;
6886 int i;
6887 u8 type;
6888
6889 type = ipw_qos_current_mode(priv);
6890
6891 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6892 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6893 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6894 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6895
6896 if (qos_network_data == NULL) {
6897 if (type == IEEE_B) {
6898 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6899 active_one = &def_parameters_CCK;
6900 } else
6901 active_one = &def_parameters_OFDM;
6902
James Ketrenosafbf30a2005-08-25 00:05:33 -05006903 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006904 burst_duration = ipw_qos_get_burst_duration(priv);
6905 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006906 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Zhu Yi851ca262006-08-21 11:37:58 +08006907 (u16)burst_duration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006908 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006909 if (type == IEEE_B) {
6910 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6911 type);
6912 if (priv->qos_data.qos_enable == 0)
6913 active_one = &def_parameters_CCK;
6914 else
6915 active_one = priv->qos_data.def_qos_parm_CCK;
6916 } else {
6917 if (priv->qos_data.qos_enable == 0)
6918 active_one = &def_parameters_OFDM;
6919 else
6920 active_one = priv->qos_data.def_qos_parm_OFDM;
6921 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006922 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006923 } else {
6924 unsigned long flags;
6925 int active;
6926
6927 spin_lock_irqsave(&priv->ieee->lock, flags);
6928 active_one = &(qos_network_data->parameters);
6929 qos_network_data->old_param_count =
6930 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006931 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006932 active = qos_network_data->supported;
6933 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6934
6935 if (active == 0) {
6936 burst_duration = ipw_qos_get_burst_duration(priv);
6937 for (i = 0; i < QOS_QUEUE_NUM; i++)
6938 qos_parameters[QOS_PARAM_SET_ACTIVE].
Zhu Yi851ca262006-08-21 11:37:58 +08006939 tx_op_limit[i] = (u16)burst_duration;
James Ketrenosb095c382005-08-24 22:04:42 -05006940 }
6941 }
6942
6943 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
Zhu Yi851ca262006-08-21 11:37:58 +08006944 for (i = 0; i < 3; i++) {
6945 int j;
6946 for (j = 0; j < QOS_QUEUE_NUM; j++) {
6947 qos_parameters[i].cw_min[j] = cpu_to_le16(qos_parameters[i].cw_min[j]);
6948 qos_parameters[i].cw_max[j] = cpu_to_le16(qos_parameters[i].cw_max[j]);
6949 qos_parameters[i].tx_op_limit[j] = cpu_to_le16(qos_parameters[i].tx_op_limit[j]);
6950 }
6951 }
6952
James Ketrenosafbf30a2005-08-25 00:05:33 -05006953 err = ipw_send_qos_params_command(priv,
6954 (struct ieee80211_qos_parameters *)
6955 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05006956 if (err)
6957 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
6958
6959 return err;
6960}
6961
6962/*
6963* send IPW_CMD_WME_INFO to the firmware
6964*/
6965static int ipw_qos_set_info_element(struct ipw_priv *priv)
6966{
6967 int ret = 0;
6968 struct ieee80211_qos_information_element qos_info;
6969
6970 if (priv == NULL)
6971 return -1;
6972
6973 qos_info.elementID = QOS_ELEMENT_ID;
6974 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
6975
6976 qos_info.version = QOS_VERSION_1;
6977 qos_info.ac_info = 0;
6978
6979 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
6980 qos_info.qui_type = QOS_OUI_TYPE;
6981 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
6982
6983 ret = ipw_send_qos_info_command(priv, &qos_info);
6984 if (ret != 0) {
6985 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
6986 }
6987 return ret;
6988}
6989
6990/*
6991* Set the QoS parameter with the association request structure
6992*/
6993static int ipw_qos_association(struct ipw_priv *priv,
6994 struct ieee80211_network *network)
6995{
6996 int err = 0;
6997 struct ieee80211_qos_data *qos_data = NULL;
6998 struct ieee80211_qos_data ibss_data = {
6999 .supported = 1,
7000 .active = 1,
7001 };
7002
7003 switch (priv->ieee->iw_mode) {
7004 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02007005 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05007006
7007 qos_data = &ibss_data;
7008 break;
7009
7010 case IW_MODE_INFRA:
7011 qos_data = &network->qos_data;
7012 break;
7013
7014 default:
7015 BUG();
7016 break;
7017 }
7018
7019 err = ipw_qos_activate(priv, qos_data);
7020 if (err) {
7021 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
7022 return err;
7023 }
7024
7025 if (priv->qos_data.qos_enable && qos_data->supported) {
7026 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
7027 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
7028 return ipw_qos_set_info_element(priv);
7029 }
7030
7031 return 0;
7032}
7033
7034/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01007035* handling the beaconing responses. if we get different QoS setting
7036* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05007037* setting
7038*/
7039static int ipw_qos_association_resp(struct ipw_priv *priv,
7040 struct ieee80211_network *network)
7041{
7042 int ret = 0;
7043 unsigned long flags;
7044 u32 size = sizeof(struct ieee80211_qos_parameters);
7045 int set_qos_param = 0;
7046
James Ketrenosafbf30a2005-08-25 00:05:33 -05007047 if ((priv == NULL) || (network == NULL) ||
7048 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05007049 return ret;
7050
7051 if (!(priv->status & STATUS_ASSOCIATED))
7052 return ret;
7053
James Ketrenosafbf30a2005-08-25 00:05:33 -05007054 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05007055 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05007056
7057 spin_lock_irqsave(&priv->ieee->lock, flags);
7058 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007059 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05007060 sizeof(struct ieee80211_qos_data));
7061 priv->assoc_network->qos_data.active = 1;
7062 if ((network->qos_data.old_param_count !=
7063 network->qos_data.param_count)) {
7064 set_qos_param = 1;
7065 network->qos_data.old_param_count =
7066 network->qos_data.param_count;
7067 }
7068
7069 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007070 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
7071 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007072 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007073 else
7074 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007075 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05007076 priv->assoc_network->qos_data.active = 0;
7077 priv->assoc_network->qos_data.supported = 0;
7078 set_qos_param = 1;
7079 }
7080
7081 spin_unlock_irqrestore(&priv->ieee->lock, flags);
7082
7083 if (set_qos_param == 1)
7084 schedule_work(&priv->qos_activate);
7085
7086 return ret;
7087}
7088
7089static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
7090{
7091 u32 ret = 0;
7092
7093 if ((priv == NULL))
7094 return 0;
7095
James Ketrenosafbf30a2005-08-25 00:05:33 -05007096 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05007097 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007098 else
James Ketrenosb095c382005-08-24 22:04:42 -05007099 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007100
James Ketrenosb095c382005-08-24 22:04:42 -05007101 return ret;
7102}
7103
7104/*
7105* Initialize the setting of QoS global
7106*/
7107static void ipw_qos_init(struct ipw_priv *priv, int enable,
7108 int burst_enable, u32 burst_duration_CCK,
7109 u32 burst_duration_OFDM)
7110{
7111 priv->qos_data.qos_enable = enable;
7112
7113 if (priv->qos_data.qos_enable) {
7114 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7115 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7116 IPW_DEBUG_QOS("QoS is enabled\n");
7117 } else {
7118 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7119 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7120 IPW_DEBUG_QOS("QoS is not enabled\n");
7121 }
7122
7123 priv->qos_data.burst_enable = burst_enable;
7124
7125 if (burst_enable) {
7126 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7127 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7128 } else {
7129 priv->qos_data.burst_duration_CCK = 0;
7130 priv->qos_data.burst_duration_OFDM = 0;
7131 }
7132}
7133
7134/*
7135* map the packet priority to the right TX Queue
7136*/
7137static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7138{
7139 if (priority > 7 || !priv->qos_data.qos_enable)
7140 priority = 0;
7141
7142 return from_priority_to_tx_queue[priority] - 1;
7143}
7144
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007145static int ipw_is_qos_active(struct net_device *dev,
7146 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007147{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007148 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007149 struct ieee80211_qos_data *qos_data = NULL;
7150 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007151 u8 *daddr = skb->data + ETH_ALEN;
7152 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007153
7154 if (!(priv->status & STATUS_ASSOCIATED))
7155 return 0;
7156
7157 qos_data = &priv->assoc_network->qos_data;
7158
James Ketrenosb095c382005-08-24 22:04:42 -05007159 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7160 if (unicast == 0)
7161 qos_data->active = 0;
7162 else
7163 qos_data->active = qos_data->supported;
7164 }
James Ketrenosb095c382005-08-24 22:04:42 -05007165 active = qos_data->active;
7166 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007167 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7168 "unicast %d\n",
7169 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007170 if (active && priv->qos_data.qos_enable)
7171 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007172
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007173 return 0;
7174
7175}
7176/*
7177* add QoS parameter to the TX command
7178*/
7179static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7180 u16 priority,
7181 struct tfd_data *tfd)
7182{
7183 int tx_queue_id = 0;
7184
7185
7186 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7187 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7188
7189 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7190 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007191 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007192 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007193 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007194}
7195
7196/*
7197* background support to run QoS activate functionality
7198*/
David Howellsc4028952006-11-22 14:57:56 +00007199static void ipw_bg_qos_activate(struct work_struct *work)
James Ketrenosb095c382005-08-24 22:04:42 -05007200{
David Howellsc4028952006-11-22 14:57:56 +00007201 struct ipw_priv *priv =
7202 container_of(work, struct ipw_priv, qos_activate);
James Ketrenosb095c382005-08-24 22:04:42 -05007203
7204 if (priv == NULL)
7205 return;
7206
Zhu Yi46441512006-01-24 16:37:59 +08007207 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007208
7209 if (priv->status & STATUS_ASSOCIATED)
7210 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7211
Zhu Yi46441512006-01-24 16:37:59 +08007212 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007213}
7214
James Ketrenos3b9990c2005-08-19 13:18:55 -05007215static int ipw_handle_probe_response(struct net_device *dev,
7216 struct ieee80211_probe_response *resp,
7217 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007218{
7219 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007220 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7221 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007222
James Ketrenos3b9990c2005-08-19 13:18:55 -05007223 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007224
James Ketrenos3b9990c2005-08-19 13:18:55 -05007225 return 0;
7226}
James Ketrenosb095c382005-08-24 22:04:42 -05007227
James Ketrenos3b9990c2005-08-19 13:18:55 -05007228static int ipw_handle_beacon(struct net_device *dev,
7229 struct ieee80211_beacon *resp,
7230 struct ieee80211_network *network)
7231{
7232 struct ipw_priv *priv = ieee80211_priv(dev);
7233 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7234 (network == priv->assoc_network));
7235
7236 ipw_qos_handle_probe_response(priv, active_network, network);
7237
7238 return 0;
7239}
7240
7241static int ipw_handle_assoc_response(struct net_device *dev,
7242 struct ieee80211_assoc_response *resp,
7243 struct ieee80211_network *network)
7244{
7245 struct ipw_priv *priv = ieee80211_priv(dev);
7246 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007247 return 0;
7248}
7249
7250static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7251 *qos_param)
7252{
Zhu Yi4e226992006-01-24 16:37:36 +08007253 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7254 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007255}
7256
7257static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7258 *qos_param)
7259{
Zhu Yi4e226992006-01-24 16:37:36 +08007260 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7261 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007262}
7263
Zhu Yie43e3c12006-04-13 17:20:45 +08007264#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007265
James Ketrenos43f66a62005-03-25 12:31:53 -06007266static int ipw_associate_network(struct ipw_priv *priv,
7267 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007268 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007269{
7270 int err;
Joe Perches0795af52007-10-03 17:59:30 -07007271 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06007272
7273 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007274 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007275
7276 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007277 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007278 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007279 memcpy(priv->essid, network->ssid, priv->essid_len);
7280 }
7281
7282 network->last_associate = jiffies;
7283
7284 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7285 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007286 priv->assoc_request.auth_key = 0;
7287
James Ketrenos43f66a62005-03-25 12:31:53 -06007288 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007289 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007290 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007291 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7292
Zhu Yi1ba61e02006-02-15 13:00:55 +08007293 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007294 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007295
7296 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7297 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7298 priv->assoc_request.auth_type = AUTH_LEAP;
7299 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007300 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007301
James Ketrenosa613bff2005-08-24 21:43:11 -05007302 if (priv->ieee->wpa_ie_len) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05007303 priv->assoc_request.policy_support = 0x02; /* RSN active */
7304 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7305 priv->ieee->wpa_ie_len);
7306 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007307
Jeff Garzikbf794512005-07-31 13:07:26 -04007308 /*
7309 * It is valid for our ieee device to support multiple modes, but
7310 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007311 * just one mode.
7312 */
7313 if (network->mode & priv->ieee->mode & IEEE_A)
7314 priv->assoc_request.ieee_mode = IPW_A_MODE;
7315 else if (network->mode & priv->ieee->mode & IEEE_G)
7316 priv->assoc_request.ieee_mode = IPW_G_MODE;
7317 else if (network->mode & priv->ieee->mode & IEEE_B)
7318 priv->assoc_request.ieee_mode = IPW_B_MODE;
7319
James Ketrenosea2b26e2005-08-24 21:25:16 -05007320 priv->assoc_request.capability = network->capability;
7321 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7322 && !(priv->config & CFG_PREAMBLE_LONG)) {
7323 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7324 } else {
7325 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7326
7327 /* Clear the short preamble if we won't be supporting it */
7328 priv->assoc_request.capability &=
7329 ~WLAN_CAPABILITY_SHORT_PREAMBLE;
7330 }
7331
James Ketrenosafbf30a2005-08-25 00:05:33 -05007332 /* Clear capability bits that aren't used in Ad Hoc */
7333 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7334 priv->assoc_request.capability &=
7335 ~WLAN_CAPABILITY_SHORT_SLOT_TIME;
7336
James Ketrenos43f66a62005-03-25 12:31:53 -06007337 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007338 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007339 roaming ? "Rea" : "A",
Jeff Garzikbf794512005-07-31 13:07:26 -04007340 escape_essid(priv->essid, priv->essid_len),
7341 network->channel,
7342 ipw_modes[priv->assoc_request.ieee_mode],
7343 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007344 (priv->assoc_request.preamble_length ==
7345 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7346 network->capability &
7347 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007348 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007349 priv->capability & CAP_PRIVACY_ON ?
7350 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007351 "(open)") : "",
7352 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007353 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007354 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007355 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007356
7357 priv->assoc_request.beacon_interval = network->beacon_interval;
7358 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007359 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007360 priv->assoc_request.assoc_type = HC_IBSS_START;
7361 priv->assoc_request.assoc_tsf_msw = 0;
7362 priv->assoc_request.assoc_tsf_lsw = 0;
7363 } else {
7364 if (unlikely(roaming))
7365 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7366 else
7367 priv->assoc_request.assoc_type = HC_ASSOCIATE;
7368 priv->assoc_request.assoc_tsf_msw = network->time_stamp[1];
7369 priv->assoc_request.assoc_tsf_lsw = network->time_stamp[0];
7370 }
7371
James Ketrenosafbf30a2005-08-25 00:05:33 -05007372 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007373
7374 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7375 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
7376 priv->assoc_request.atim_window = network->atim_window;
7377 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007378 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007379 priv->assoc_request.atim_window = 0;
7380 }
7381
James Ketrenos43f66a62005-03-25 12:31:53 -06007382 priv->assoc_request.listen_interval = network->listen_interval;
Jeff Garzikbf794512005-07-31 13:07:26 -04007383
James Ketrenos43f66a62005-03-25 12:31:53 -06007384 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7385 if (err) {
7386 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7387 return err;
7388 }
7389
7390 rates->ieee_mode = priv->assoc_request.ieee_mode;
7391 rates->purpose = IPW_RATE_CONNECT;
7392 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007393
James Ketrenos43f66a62005-03-25 12:31:53 -06007394 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7395 priv->sys_config.dot11g_auto_detection = 1;
7396 else
7397 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007398
7399 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7400 priv->sys_config.answer_broadcast_ssid_probe = 1;
7401 else
7402 priv->sys_config.answer_broadcast_ssid_probe = 0;
7403
Zhu Yid685b8c2006-04-13 17:20:27 +08007404 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007405 if (err) {
7406 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7407 return err;
7408 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007409
James Ketrenos43f66a62005-03-25 12:31:53 -06007410 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007411 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007412 if (err) {
7413 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7414 return err;
7415 }
7416
7417 /*
7418 * If preemption is enabled, it is possible for the association
7419 * to complete before we return from ipw_send_associate. Therefore
7420 * we have to be sure and update our priviate data first.
7421 */
7422 priv->channel = network->channel;
7423 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007424 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007425 priv->status &= ~STATUS_SECURITY_UPDATED;
7426
7427 priv->assoc_network = network;
7428
Zhu Yie43e3c12006-04-13 17:20:45 +08007429#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007430 ipw_qos_association(priv, network);
7431#endif
7432
James Ketrenos43f66a62005-03-25 12:31:53 -06007433 err = ipw_send_associate(priv, &priv->assoc_request);
7434 if (err) {
7435 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7436 return err;
7437 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007438
Joe Perches0795af52007-10-03 17:59:30 -07007439 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' %s \n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007440 escape_essid(priv->essid, priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07007441 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06007442
7443 return 0;
7444}
7445
7446static void ipw_roam(void *data)
7447{
7448 struct ipw_priv *priv = data;
7449 struct ieee80211_network *network = NULL;
7450 struct ipw_network_match match = {
7451 .network = priv->assoc_network
7452 };
7453
7454 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007455 *
7456 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007457 * setting the status ROAM bit and requesting a scan.
7458 * 2. When the scan completes, it schedules the ROAM work
7459 * 3. The ROAM work looks at all of the known networks for one that
7460 * is a better network than the currently associated. If none
7461 * found, the ROAM process is over (ROAM bit cleared)
7462 * 4. If a better network is found, a disassociation request is
7463 * sent.
7464 * 5. When the disassociation completes, the roam work is again
7465 * scheduled. The second time through, the driver is no longer
7466 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007467 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007468 * 6. At this point ,the roaming process is complete and the ROAM
7469 * status bit is cleared.
7470 */
7471
7472 /* If we are no longer associated, and the roaming bit is no longer
7473 * set, then we are not actively roaming, so just return */
7474 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7475 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007476
James Ketrenos43f66a62005-03-25 12:31:53 -06007477 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007478 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007479 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007480 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007481 u8 rssi = priv->assoc_network->stats.rssi;
7482 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007483 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007484 list_for_each_entry(network, &priv->ieee->network_list, list) {
7485 if (network != priv->assoc_network)
7486 ipw_best_network(priv, &match, network, 1);
7487 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007488 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007489 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007490
James Ketrenos43f66a62005-03-25 12:31:53 -06007491 if (match.network == priv->assoc_network) {
7492 IPW_DEBUG_ASSOC("No better APs in this network to "
7493 "roam to.\n");
7494 priv->status &= ~STATUS_ROAMING;
7495 ipw_debug_config(priv);
7496 return;
7497 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007498
James Ketrenos43f66a62005-03-25 12:31:53 -06007499 ipw_send_disassociate(priv, 1);
7500 priv->assoc_network = match.network;
7501
7502 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007503 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007504
7505 /* Second pass through ROAM process -- request association */
7506 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7507 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7508 priv->status &= ~STATUS_ROAMING;
7509}
7510
David Howellsc4028952006-11-22 14:57:56 +00007511static void ipw_bg_roam(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05007512{
David Howellsc4028952006-11-22 14:57:56 +00007513 struct ipw_priv *priv =
7514 container_of(work, struct ipw_priv, roam);
Zhu Yi46441512006-01-24 16:37:59 +08007515 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007516 ipw_roam(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007517 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007518}
7519
7520static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007521{
7522 struct ipw_priv *priv = data;
7523
7524 struct ieee80211_network *network = NULL;
7525 struct ipw_network_match match = {
7526 .network = NULL
7527 };
7528 struct ipw_supported_rates *rates;
7529 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007530 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007531
James Ketrenosb095c382005-08-24 22:04:42 -05007532 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7533 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7534 return 0;
7535 }
7536
James Ketrenosc848d0a2005-08-24 21:56:24 -05007537 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007538 IPW_DEBUG_ASSOC("Not attempting association (already in "
7539 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007540 return 0;
7541 }
7542
Hong Liue6324722005-09-14 21:04:15 -05007543 if (priv->status & STATUS_DISASSOCIATING) {
7544 IPW_DEBUG_ASSOC("Not attempting association (in "
7545 "disassociating)\n ");
7546 queue_work(priv->workqueue, &priv->associate);
7547 return 0;
7548 }
7549
James Ketrenosc848d0a2005-08-24 21:56:24 -05007550 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007551 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7552 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007553 return 0;
7554 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007555
7556 if (!(priv->config & CFG_ASSOCIATE) &&
7557 !(priv->config & (CFG_STATIC_ESSID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007558 CFG_STATIC_CHANNEL | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007559 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007560 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007561 }
7562
James Ketrenosa613bff2005-08-24 21:43:11 -05007563 /* Protect our use of the network_list */
7564 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007565 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007566 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007567
7568 network = match.network;
7569 rates = &match.rates;
7570
7571 if (network == NULL &&
7572 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7573 priv->config & CFG_ADHOC_CREATE &&
7574 priv->config & CFG_STATIC_ESSID &&
James Ketrenosa613bff2005-08-24 21:43:11 -05007575 priv->config & CFG_STATIC_CHANNEL &&
James Ketrenos43f66a62005-03-25 12:31:53 -06007576 !list_empty(&priv->ieee->network_free_list)) {
7577 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007578 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007579 ipw_adhoc_create(priv, network);
7580 rates = &priv->rates;
7581 list_del(element);
7582 list_add_tail(&network->list, &priv->ieee->network_list);
7583 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007584 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007585
James Ketrenos43f66a62005-03-25 12:31:53 -06007586 /* If we reached the end of the list, then we don't have any valid
7587 * matching APs */
7588 if (!network) {
7589 ipw_debug_config(priv);
7590
James Ketrenosb095c382005-08-24 22:04:42 -05007591 if (!(priv->status & STATUS_SCANNING)) {
7592 if (!(priv->config & CFG_SPEED_SCAN))
7593 queue_delayed_work(priv->workqueue,
7594 &priv->request_scan,
7595 SCAN_INTERVAL);
7596 else
David Howellsc4028952006-11-22 14:57:56 +00007597 queue_delayed_work(priv->workqueue,
7598 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05007599 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007600
James Ketrenosc848d0a2005-08-24 21:56:24 -05007601 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007602 }
7603
7604 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007605
7606 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007607}
Jeff Garzikbf794512005-07-31 13:07:26 -04007608
David Howellsc4028952006-11-22 14:57:56 +00007609static void ipw_bg_associate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06007610{
David Howellsc4028952006-11-22 14:57:56 +00007611 struct ipw_priv *priv =
7612 container_of(work, struct ipw_priv, associate);
Zhu Yi46441512006-01-24 16:37:59 +08007613 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007614 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007615 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007616}
7617
James Ketrenosb095c382005-08-24 22:04:42 -05007618static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7619 struct sk_buff *skb)
7620{
7621 struct ieee80211_hdr *hdr;
7622 u16 fc;
7623
7624 hdr = (struct ieee80211_hdr *)skb->data;
7625 fc = le16_to_cpu(hdr->frame_ctl);
7626 if (!(fc & IEEE80211_FCTL_PROTECTED))
7627 return;
7628
7629 fc &= ~IEEE80211_FCTL_PROTECTED;
7630 hdr->frame_ctl = cpu_to_le16(fc);
7631 switch (priv->ieee->sec.level) {
7632 case SEC_LEVEL_3:
7633 /* Remove CCMP HDR */
7634 memmove(skb->data + IEEE80211_3ADDR_LEN,
7635 skb->data + IEEE80211_3ADDR_LEN + 8,
7636 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007637 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007638 break;
7639 case SEC_LEVEL_2:
7640 break;
7641 case SEC_LEVEL_1:
7642 /* Remove IV */
7643 memmove(skb->data + IEEE80211_3ADDR_LEN,
7644 skb->data + IEEE80211_3ADDR_LEN + 4,
7645 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007646 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007647 break;
7648 case SEC_LEVEL_0:
7649 break;
7650 default:
7651 printk(KERN_ERR "Unknow security level %d\n",
7652 priv->ieee->sec.level);
7653 break;
7654 }
7655}
7656
7657static void ipw_handle_data_packet(struct ipw_priv *priv,
7658 struct ipw_rx_mem_buffer *rxb,
7659 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007660{
Hong Liu567deaf2005-08-31 18:07:22 +08007661 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007662 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7663
7664 /* We received data from the HW, so stop the watchdog */
7665 priv->net_dev->trans_start = jiffies;
7666
Jeff Garzikbf794512005-07-31 13:07:26 -04007667 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007668 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007669 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007670 skb_tailroom(rxb->skb))) {
7671 priv->ieee->stats.rx_errors++;
7672 priv->wstats.discard.misc++;
7673 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7674 return;
7675 } else if (unlikely(!netif_running(priv->net_dev))) {
7676 priv->ieee->stats.rx_dropped++;
7677 priv->wstats.discard.misc++;
7678 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7679 return;
7680 }
7681
7682 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007683 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007684
7685 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007686 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007687
7688 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7689
James Ketrenosb095c382005-08-24 22:04:42 -05007690 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007691 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7692 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007693 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007694 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007695 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7696
Jeff Garzikbf794512005-07-31 13:07:26 -04007697 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
James Ketrenos43f66a62005-03-25 12:31:53 -06007698 priv->ieee->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007699 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007700 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007701 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007702 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007703}
7704
Zhu Yi459d4082006-04-13 17:21:00 +08007705#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007706static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7707 struct ipw_rx_mem_buffer *rxb,
7708 struct ieee80211_rx_stats *stats)
7709{
7710 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7711 struct ipw_rx_frame *frame = &pkt->u.frame;
7712
7713 /* initial pull of some data */
7714 u16 received_channel = frame->received_channel;
7715 u8 antennaAndPhy = frame->antennaAndPhy;
7716 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7717 u16 pktrate = frame->rate;
7718
7719 /* Magic struct that slots into the radiotap header -- no reason
7720 * to build this manually element by element, we can write it much
7721 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007722 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007723
7724 short len = le16_to_cpu(pkt->u.frame.length);
7725
7726 /* We received data from the HW, so stop the watchdog */
7727 priv->net_dev->trans_start = jiffies;
7728
7729 /* We only process data packets if the
7730 * interface is open */
7731 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7732 skb_tailroom(rxb->skb))) {
7733 priv->ieee->stats.rx_errors++;
7734 priv->wstats.discard.misc++;
7735 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7736 return;
7737 } else if (unlikely(!netif_running(priv->net_dev))) {
7738 priv->ieee->stats.rx_dropped++;
7739 priv->wstats.discard.misc++;
7740 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7741 return;
7742 }
7743
7744 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7745 * that now */
7746 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7747 /* FIXME: Should alloc bigger skb instead */
7748 priv->ieee->stats.rx_dropped++;
7749 priv->wstats.discard.misc++;
7750 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7751 return;
7752 }
7753
7754 /* copy the frame itself */
7755 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7756 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7757
7758 /* Zero the radiotap static buffer ... We only need to zero the bytes NOT
7759 * part of our real header, saves a little time.
7760 *
7761 * No longer necessary since we fill in all our data. Purge before merging
7762 * patch officially.
7763 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7764 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7765 */
7766
7767 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7768
7769 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7770 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7771 ipw_rt->rt_hdr.it_len = sizeof(struct ipw_rt_hdr); /* total header+data */
7772
7773 /* Big bitfield of all the fields we provide in radiotap */
7774 ipw_rt->rt_hdr.it_present =
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007775 ((1 << IEEE80211_RADIOTAP_TSFT) |
7776 (1 << IEEE80211_RADIOTAP_FLAGS) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007777 (1 << IEEE80211_RADIOTAP_RATE) |
7778 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7779 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007780 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007781 (1 << IEEE80211_RADIOTAP_ANTENNA));
7782
7783 /* Zero the flags, we'll add to them as we go */
7784 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007785 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7786 frame->parent_tsf[2] << 16 |
7787 frame->parent_tsf[1] << 8 |
7788 frame->parent_tsf[0]);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007789
7790 /* Convert signal to DBM */
7791 ipw_rt->rt_dbmsignal = antsignal;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007792 ipw_rt->rt_dbmnoise = frame->noise;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007793
7794 /* Convert the channel data and set the flags */
7795 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7796 if (received_channel > 14) { /* 802.11a */
7797 ipw_rt->rt_chbitmask =
7798 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7799 } else if (antennaAndPhy & 32) { /* 802.11b */
7800 ipw_rt->rt_chbitmask =
7801 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7802 } else { /* 802.11g */
7803 ipw_rt->rt_chbitmask =
7804 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7805 }
7806
7807 /* set the rate in multiples of 500k/s */
7808 switch (pktrate) {
7809 case IPW_TX_RATE_1MB:
7810 ipw_rt->rt_rate = 2;
7811 break;
7812 case IPW_TX_RATE_2MB:
7813 ipw_rt->rt_rate = 4;
7814 break;
7815 case IPW_TX_RATE_5MB:
7816 ipw_rt->rt_rate = 10;
7817 break;
7818 case IPW_TX_RATE_6MB:
7819 ipw_rt->rt_rate = 12;
7820 break;
7821 case IPW_TX_RATE_9MB:
7822 ipw_rt->rt_rate = 18;
7823 break;
7824 case IPW_TX_RATE_11MB:
7825 ipw_rt->rt_rate = 22;
7826 break;
7827 case IPW_TX_RATE_12MB:
7828 ipw_rt->rt_rate = 24;
7829 break;
7830 case IPW_TX_RATE_18MB:
7831 ipw_rt->rt_rate = 36;
7832 break;
7833 case IPW_TX_RATE_24MB:
7834 ipw_rt->rt_rate = 48;
7835 break;
7836 case IPW_TX_RATE_36MB:
7837 ipw_rt->rt_rate = 72;
7838 break;
7839 case IPW_TX_RATE_48MB:
7840 ipw_rt->rt_rate = 96;
7841 break;
7842 case IPW_TX_RATE_54MB:
7843 ipw_rt->rt_rate = 108;
7844 break;
7845 default:
7846 ipw_rt->rt_rate = 0;
7847 break;
7848 }
7849
7850 /* antenna number */
7851 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7852
7853 /* set the preamble flag if we have it */
7854 if ((antennaAndPhy & 64))
7855 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7856
7857 /* Set the size of the skb to the size of the frame */
7858 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007859
7860 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7861
7862 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
7863 priv->ieee->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007864 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007865 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007866 /* no LED during capture */
7867 }
7868}
7869#endif
7870
Zhu Yid685b8c2006-04-13 17:20:27 +08007871#ifdef CONFIG_IPW2200_PROMISCUOUS
7872#define ieee80211_is_probe_response(fc) \
7873 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7874 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7875
7876#define ieee80211_is_management(fc) \
7877 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7878
7879#define ieee80211_is_control(fc) \
7880 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7881
7882#define ieee80211_is_data(fc) \
7883 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7884
7885#define ieee80211_is_assoc_request(fc) \
7886 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7887
7888#define ieee80211_is_reassoc_request(fc) \
7889 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7890
7891static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7892 struct ipw_rx_mem_buffer *rxb,
7893 struct ieee80211_rx_stats *stats)
7894{
7895 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7896 struct ipw_rx_frame *frame = &pkt->u.frame;
7897 struct ipw_rt_hdr *ipw_rt;
7898
7899 /* First cache any information we need before we overwrite
7900 * the information provided in the skb from the hardware */
7901 struct ieee80211_hdr *hdr;
7902 u16 channel = frame->received_channel;
7903 u8 phy_flags = frame->antennaAndPhy;
7904 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7905 s8 noise = frame->noise;
7906 u8 rate = frame->rate;
7907 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007908 struct sk_buff *skb;
7909 int hdr_only = 0;
7910 u16 filter = priv->prom_priv->filter;
7911
7912 /* If the filter is set to not include Rx frames then return */
7913 if (filter & IPW_PROM_NO_RX)
7914 return;
7915
Zhu Yid685b8c2006-04-13 17:20:27 +08007916 /* We received data from the HW, so stop the watchdog */
7917 priv->prom_net_dev->trans_start = jiffies;
7918
7919 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
7920 priv->prom_priv->ieee->stats.rx_errors++;
7921 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7922 return;
7923 }
7924
7925 /* We only process data packets if the interface is open */
7926 if (unlikely(!netif_running(priv->prom_net_dev))) {
7927 priv->prom_priv->ieee->stats.rx_dropped++;
7928 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7929 return;
7930 }
7931
7932 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7933 * that now */
7934 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7935 /* FIXME: Should alloc bigger skb instead */
7936 priv->prom_priv->ieee->stats.rx_dropped++;
7937 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7938 return;
7939 }
7940
7941 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
Zhu Yi851ca262006-08-21 11:37:58 +08007942 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007943 if (filter & IPW_PROM_NO_MGMT)
7944 return;
7945 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
7946 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007947 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007948 if (filter & IPW_PROM_NO_CTL)
7949 return;
7950 if (filter & IPW_PROM_CTL_HEADER_ONLY)
7951 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007952 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007953 if (filter & IPW_PROM_NO_DATA)
7954 return;
7955 if (filter & IPW_PROM_DATA_HEADER_ONLY)
7956 hdr_only = 1;
7957 }
7958
7959 /* Copy the SKB since this is for the promiscuous side */
7960 skb = skb_copy(rxb->skb, GFP_ATOMIC);
7961 if (skb == NULL) {
7962 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
7963 return;
7964 }
7965
7966 /* copy the frame data to write after where the radiotap header goes */
7967 ipw_rt = (void *)skb->data;
7968
7969 if (hdr_only)
Zhu Yi851ca262006-08-21 11:37:58 +08007970 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +08007971
7972 memcpy(ipw_rt->payload, hdr, len);
7973
7974 /* Zero the radiotap static buffer ... We only need to zero the bytes
7975 * NOT part of our real header, saves a little time.
7976 *
7977 * No longer necessary since we fill in all our data. Purge before
7978 * merging patch officially.
7979 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7980 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7981 */
7982
7983 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7984 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7985 ipw_rt->rt_hdr.it_len = sizeof(*ipw_rt); /* total header+data */
7986
7987 /* Set the size of the skb to the size of the frame */
7988 skb_put(skb, ipw_rt->rt_hdr.it_len + len);
7989
7990 /* Big bitfield of all the fields we provide in radiotap */
7991 ipw_rt->rt_hdr.it_present =
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007992 ((1 << IEEE80211_RADIOTAP_TSFT) |
7993 (1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007994 (1 << IEEE80211_RADIOTAP_RATE) |
7995 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7996 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
7997 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
7998 (1 << IEEE80211_RADIOTAP_ANTENNA));
7999
8000 /* Zero the flags, we'll add to them as we go */
8001 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08008002 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
8003 frame->parent_tsf[2] << 16 |
8004 frame->parent_tsf[1] << 8 |
8005 frame->parent_tsf[0]);
Zhu Yid685b8c2006-04-13 17:20:27 +08008006
8007 /* Convert to DBM */
8008 ipw_rt->rt_dbmsignal = signal;
8009 ipw_rt->rt_dbmnoise = noise;
8010
8011 /* Convert the channel data and set the flags */
8012 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
8013 if (channel > 14) { /* 802.11a */
8014 ipw_rt->rt_chbitmask =
8015 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
8016 } else if (phy_flags & (1 << 5)) { /* 802.11b */
8017 ipw_rt->rt_chbitmask =
8018 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
8019 } else { /* 802.11g */
8020 ipw_rt->rt_chbitmask =
8021 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
8022 }
8023
8024 /* set the rate in multiples of 500k/s */
8025 switch (rate) {
8026 case IPW_TX_RATE_1MB:
8027 ipw_rt->rt_rate = 2;
8028 break;
8029 case IPW_TX_RATE_2MB:
8030 ipw_rt->rt_rate = 4;
8031 break;
8032 case IPW_TX_RATE_5MB:
8033 ipw_rt->rt_rate = 10;
8034 break;
8035 case IPW_TX_RATE_6MB:
8036 ipw_rt->rt_rate = 12;
8037 break;
8038 case IPW_TX_RATE_9MB:
8039 ipw_rt->rt_rate = 18;
8040 break;
8041 case IPW_TX_RATE_11MB:
8042 ipw_rt->rt_rate = 22;
8043 break;
8044 case IPW_TX_RATE_12MB:
8045 ipw_rt->rt_rate = 24;
8046 break;
8047 case IPW_TX_RATE_18MB:
8048 ipw_rt->rt_rate = 36;
8049 break;
8050 case IPW_TX_RATE_24MB:
8051 ipw_rt->rt_rate = 48;
8052 break;
8053 case IPW_TX_RATE_36MB:
8054 ipw_rt->rt_rate = 72;
8055 break;
8056 case IPW_TX_RATE_48MB:
8057 ipw_rt->rt_rate = 96;
8058 break;
8059 case IPW_TX_RATE_54MB:
8060 ipw_rt->rt_rate = 108;
8061 break;
8062 default:
8063 ipw_rt->rt_rate = 0;
8064 break;
8065 }
8066
8067 /* antenna number */
8068 ipw_rt->rt_antenna = (phy_flags & 3);
8069
8070 /* set the preamble flag if we have it */
8071 if (phy_flags & (1 << 6))
8072 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
8073
8074 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
8075
8076 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
8077 priv->prom_priv->ieee->stats.rx_errors++;
8078 dev_kfree_skb_any(skb);
8079 }
8080}
8081#endif
8082
Arjan van de Ven858119e2006-01-14 13:20:43 -08008083static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05008084 struct ieee80211_hdr_4addr *header)
8085{
8086 /* Filter incoming packets to determine if they are targetted toward
8087 * this network, discarding packets coming from ourselves */
8088 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05008089 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008090 /* packets from our adapter are dropped (echo) */
8091 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
8092 return 0;
8093
Peter Jones90700fd2005-08-26 16:51:06 -05008094 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008095 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05008096 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008097
8098 /* packets to our adapter go through */
8099 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8100 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008101
Peter Jones90700fd2005-08-26 16:51:06 -05008102 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008103 /* packets from our adapter are dropped (echo) */
8104 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
8105 return 0;
8106
Peter Jones90700fd2005-08-26 16:51:06 -05008107 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008108 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05008109 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
8110
8111 /* packets to our adapter go through */
8112 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8113 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05008114 }
James Ketrenosa613bff2005-08-24 21:43:11 -05008115
James Ketrenosea2b26e2005-08-24 21:25:16 -05008116 return 1;
8117}
8118
James Ketrenosafbf30a2005-08-25 00:05:33 -05008119#define IPW_PACKET_RETRY_TIME HZ
8120
Arjan van de Ven858119e2006-01-14 13:20:43 -08008121static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05008122 struct ieee80211_hdr_4addr *header)
8123{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008124 u16 sc = le16_to_cpu(header->seq_ctl);
8125 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8126 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8127 u16 *last_seq, *last_frag;
8128 unsigned long *last_time;
8129
8130 switch (priv->ieee->iw_mode) {
8131 case IW_MODE_ADHOC:
8132 {
8133 struct list_head *p;
8134 struct ipw_ibss_seq *entry = NULL;
8135 u8 *mac = header->addr2;
8136 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8137
8138 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8139 entry =
8140 list_entry(p, struct ipw_ibss_seq, list);
8141 if (!memcmp(entry->mac, mac, ETH_ALEN))
8142 break;
8143 }
8144 if (p == &priv->ibss_mac_hash[index]) {
8145 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8146 if (!entry) {
8147 IPW_ERROR
8148 ("Cannot malloc new mac entry\n");
8149 return 0;
8150 }
8151 memcpy(entry->mac, mac, ETH_ALEN);
8152 entry->seq_num = seq;
8153 entry->frag_num = frag;
8154 entry->packet_time = jiffies;
8155 list_add(&entry->list,
8156 &priv->ibss_mac_hash[index]);
8157 return 0;
8158 }
8159 last_seq = &entry->seq_num;
8160 last_frag = &entry->frag_num;
8161 last_time = &entry->packet_time;
8162 break;
8163 }
8164 case IW_MODE_INFRA:
8165 last_seq = &priv->last_seq_num;
8166 last_frag = &priv->last_frag_num;
8167 last_time = &priv->last_packet_time;
8168 break;
8169 default:
8170 return 0;
8171 }
8172 if ((*last_seq == seq) &&
8173 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8174 if (*last_frag == frag)
8175 goto drop;
8176 if (*last_frag + 1 != frag)
8177 /* out-of-order fragment */
8178 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008179 } else
8180 *last_seq = seq;
8181
Zhu Yif57ce7c2005-07-13 12:22:15 -05008182 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008183 *last_time = jiffies;
8184 return 0;
8185
8186 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008187 /* Comment this line now since we observed the card receives
8188 * duplicate packets but the FCTL_RETRY bit is not set in the
8189 * IBSS mode with fragmentation enabled.
8190 BUG_ON(!(le16_to_cpu(header->frame_ctl) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008191 return 1;
8192}
8193
James Ketrenosb095c382005-08-24 22:04:42 -05008194static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8195 struct ipw_rx_mem_buffer *rxb,
8196 struct ieee80211_rx_stats *stats)
8197{
8198 struct sk_buff *skb = rxb->skb;
8199 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8200 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8201 (skb->data + IPW_RX_FRAME_SIZE);
8202
8203 ieee80211_rx_mgt(priv->ieee, header, stats);
8204
8205 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8206 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8207 IEEE80211_STYPE_PROBE_RESP) ||
8208 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8209 IEEE80211_STYPE_BEACON))) {
8210 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8211 ipw_add_station(priv, header->addr2);
8212 }
8213
8214 if (priv->config & CFG_NET_STATS) {
8215 IPW_DEBUG_HC("sending stat packet\n");
8216
8217 /* Set the size of the skb to the size of the full
8218 * ipw header and 802.11 frame */
8219 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8220 IPW_RX_FRAME_SIZE);
8221
8222 /* Advance past the ipw packet header to the 802.11 frame */
8223 skb_pull(skb, IPW_RX_FRAME_SIZE);
8224
8225 /* Push the ieee80211_rx_stats before the 802.11 frame */
8226 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8227
8228 skb->dev = priv->ieee->dev;
8229
8230 /* Point raw at the ieee80211_stats */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07008231 skb_reset_mac_header(skb);
James Ketrenosb095c382005-08-24 22:04:42 -05008232
8233 skb->pkt_type = PACKET_OTHERHOST;
8234 skb->protocol = __constant_htons(ETH_P_80211_STATS);
8235 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8236 netif_rx(skb);
8237 rxb->skb = NULL;
8238 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008239}
8240
James Ketrenos43f66a62005-03-25 12:31:53 -06008241/*
8242 * Main entry function for recieving a packet with 80211 headers. This
8243 * should be called when ever the FW has notified us that there is a new
8244 * skb in the recieve queue.
8245 */
8246static void ipw_rx(struct ipw_priv *priv)
8247{
8248 struct ipw_rx_mem_buffer *rxb;
8249 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008250 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008251 u32 r, w, i;
8252 u8 network_packet;
Joe Perches0795af52007-10-03 17:59:30 -07008253 DECLARE_MAC_BUF(mac);
8254 DECLARE_MAC_BUF(mac2);
8255 DECLARE_MAC_BUF(mac3);
James Ketrenos43f66a62005-03-25 12:31:53 -06008256
James Ketrenosb095c382005-08-24 22:04:42 -05008257 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8258 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
James Ketrenos43f66a62005-03-25 12:31:53 -06008259 i = (priv->rxq->processed + 1) % RX_QUEUE_SIZE;
8260
8261 while (i != r) {
8262 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008263 if (unlikely(rxb == NULL)) {
8264 printk(KERN_CRIT "Queue not allocated!\n");
8265 break;
8266 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008267 priv->rxq->queue[i] = NULL;
8268
8269 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008270 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008271 PCI_DMA_FROMDEVICE);
8272
8273 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8274 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8275 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008276 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008277
8278 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008279 case RX_FRAME_TYPE: /* 802.11 frame */ {
8280 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008281 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008282 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008283 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008284 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8285 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008286 .noise =
8287 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008288 .rate = pkt->u.frame.rate,
8289 .mac_time = jiffies,
8290 .received_channel =
8291 pkt->u.frame.received_channel,
8292 .freq =
8293 (pkt->u.frame.
8294 control & (1 << 0)) ?
8295 IEEE80211_24GHZ_BAND :
8296 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008297 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008298 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008299
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008300 if (stats.rssi != 0)
8301 stats.mask |= IEEE80211_STATMASK_RSSI;
8302 if (stats.signal != 0)
8303 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008304 if (stats.noise != 0)
8305 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008306 if (stats.rate != 0)
8307 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008308
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008309 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008310
Zhu Yid685b8c2006-04-13 17:20:27 +08008311#ifdef CONFIG_IPW2200_PROMISCUOUS
8312 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8313 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8314#endif
8315
James Ketrenosb095c382005-08-24 22:04:42 -05008316#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008317 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008318#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008319
8320 ipw_handle_data_packet_monitor(priv,
8321 rxb,
8322 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008323#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008324 ipw_handle_data_packet(priv, rxb,
8325 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008326#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008327 break;
8328 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008329#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008330
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008331 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008332 (struct ieee80211_hdr_4addr *)(rxb->skb->
8333 data +
8334 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008335 /* TODO: Check Ad-Hoc dest/source and make sure
8336 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008337 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008338 * frame control of the packet and disregard
8339 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008340
James Ketrenosea2b26e2005-08-24 21:25:16 -05008341 network_packet =
8342 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008343 if (network_packet && priv->assoc_network) {
8344 priv->assoc_network->stats.rssi =
8345 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008346 priv->exp_avg_rssi =
8347 exponential_average(priv->exp_avg_rssi,
8348 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008349 }
8350
8351 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008352 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008353
James Ketrenosa613bff2005-08-24 21:43:11 -05008354 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008355 ieee80211_get_hdrlen(le16_to_cpu(
8356 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008357 IPW_DEBUG_DROP
8358 ("Received packet is too small. "
8359 "Dropping.\n");
8360 priv->ieee->stats.rx_errors++;
8361 priv->wstats.discard.misc++;
8362 break;
8363 }
8364
James Ketrenosa613bff2005-08-24 21:43:11 -05008365 switch (WLAN_FC_GET_TYPE
8366 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008367
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008368 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008369 ipw_handle_mgmt_packet(priv, rxb,
8370 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008371 break;
8372
8373 case IEEE80211_FTYPE_CTL:
8374 break;
8375
8376 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008377 if (unlikely(!network_packet ||
8378 is_duplicate_packet(priv,
8379 header)))
8380 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008381 IPW_DEBUG_DROP("Dropping: "
Joe Perches0795af52007-10-03 17:59:30 -07008382 "%s, "
8383 "%s, "
8384 "%s\n",
8385 print_mac(mac,
8386 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008387 addr1),
Joe Perches0795af52007-10-03 17:59:30 -07008388 print_mac(mac2,
8389 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008390 addr2),
Joe Perches0795af52007-10-03 17:59:30 -07008391 print_mac(mac3,
8392 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008393 addr3));
James Ketrenosb095c382005-08-24 22:04:42 -05008394 break;
8395 }
8396
8397 ipw_handle_data_packet(priv, rxb,
8398 &stats);
8399
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008400 break;
8401 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008402 break;
8403 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008404
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008405 case RX_HOST_NOTIFICATION_TYPE:{
8406 IPW_DEBUG_RX
8407 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008408 pkt->u.notification.subtype,
8409 pkt->u.notification.flags,
Zhu Yi720eeb42006-12-05 14:41:40 +08008410 le16_to_cpu(pkt->u.notification.size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008411 ipw_rx_notification(priv, &pkt->u.notification);
8412 break;
8413 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008414
8415 default:
8416 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8417 pkt->header.message_type);
8418 break;
8419 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008420
8421 /* For now we just don't re-use anything. We can tweak this
8422 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008423 * fail to Rx correctly */
8424 if (rxb->skb != NULL) {
8425 dev_kfree_skb_any(rxb->skb);
8426 rxb->skb = NULL;
8427 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008428
James Ketrenos43f66a62005-03-25 12:31:53 -06008429 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008430 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008431 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008432
James Ketrenos43f66a62005-03-25 12:31:53 -06008433 i = (i + 1) % RX_QUEUE_SIZE;
8434 }
8435
8436 /* Backtrack one entry */
8437 priv->rxq->processed = (i ? i : RX_QUEUE_SIZE) - 1;
8438
8439 ipw_rx_queue_restock(priv);
8440}
8441
James Ketrenosafbf30a2005-08-25 00:05:33 -05008442#define DEFAULT_RTS_THRESHOLD 2304U
8443#define MIN_RTS_THRESHOLD 1U
8444#define MAX_RTS_THRESHOLD 2304U
8445#define DEFAULT_BEACON_INTERVAL 100U
8446#define DEFAULT_SHORT_RETRY_LIMIT 7U
8447#define DEFAULT_LONG_RETRY_LIMIT 4U
8448
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008449/**
8450 * ipw_sw_reset
8451 * @option: options to control different reset behaviour
8452 * 0 = reset everything except the 'disable' module_param
8453 * 1 = reset everything and print out driver info (for probe only)
8454 * 2 = reset everything
8455 */
8456static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008457{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008458 int band, modulation;
8459 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008460
James Ketrenosafbf30a2005-08-25 00:05:33 -05008461 /* Initialize module parameter values here */
8462 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008463
James Ketrenosafbf30a2005-08-25 00:05:33 -05008464 /* We default to disabling the LED code as right now it causes
8465 * too many systems to lock up... */
8466 if (!led)
8467 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008468
James Ketrenosafbf30a2005-08-25 00:05:33 -05008469 if (associate)
8470 priv->config |= CFG_ASSOCIATE;
8471 else
8472 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008473
James Ketrenosafbf30a2005-08-25 00:05:33 -05008474 if (auto_create)
8475 priv->config |= CFG_ADHOC_CREATE;
8476 else
8477 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8478
Zhu Yi17ed0812006-01-24 16:36:31 +08008479 priv->config &= ~CFG_STATIC_ESSID;
8480 priv->essid_len = 0;
8481 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8482
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008483 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008484 priv->status |= STATUS_RF_KILL_SW;
8485 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008486 }
8487
James Ketrenosafbf30a2005-08-25 00:05:33 -05008488 if (channel != 0) {
8489 priv->config |= CFG_STATIC_CHANNEL;
8490 priv->channel = channel;
8491 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8492 /* TODO: Validate that provided channel is in range */
8493 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008494#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008495 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8496 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008497#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008498
8499 switch (mode) {
8500 case 1:
8501 priv->ieee->iw_mode = IW_MODE_ADHOC;
8502 priv->net_dev->type = ARPHRD_ETHER;
8503
8504 break;
8505#ifdef CONFIG_IPW2200_MONITOR
8506 case 2:
8507 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008508#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008509 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8510#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008511 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008512#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008513 break;
8514#endif
8515 default:
8516 case 0:
8517 priv->net_dev->type = ARPHRD_ETHER;
8518 priv->ieee->iw_mode = IW_MODE_INFRA;
8519 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008520 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008521
James Ketrenosafbf30a2005-08-25 00:05:33 -05008522 if (hwcrypto) {
8523 priv->ieee->host_encrypt = 0;
8524 priv->ieee->host_encrypt_msdu = 0;
8525 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008526 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008527 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008528 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008529
Zhu Yie402c932005-08-05 17:20:40 +08008530 /* IPW2200/2915 is abled to do hardware fragmentation. */
8531 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008532
James Ketrenosafbf30a2005-08-25 00:05:33 -05008533 if ((priv->pci_dev->device == 0x4223) ||
8534 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008535 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008536 printk(KERN_INFO DRV_NAME
8537 ": Detected Intel PRO/Wireless 2915ABG Network "
8538 "Connection\n");
8539 priv->ieee->abg_true = 1;
8540 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8541 modulation = IEEE80211_OFDM_MODULATION |
8542 IEEE80211_CCK_MODULATION;
8543 priv->adapter = IPW_2915ABG;
8544 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008545 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008546 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008547 printk(KERN_INFO DRV_NAME
8548 ": Detected Intel PRO/Wireless 2200BG Network "
8549 "Connection\n");
8550
8551 priv->ieee->abg_true = 0;
8552 band = IEEE80211_24GHZ_BAND;
8553 modulation = IEEE80211_OFDM_MODULATION |
8554 IEEE80211_CCK_MODULATION;
8555 priv->adapter = IPW_2200BG;
8556 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008557 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008558
James Ketrenosafbf30a2005-08-25 00:05:33 -05008559 priv->ieee->freq_band = band;
8560 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008561
James Ketrenosafbf30a2005-08-25 00:05:33 -05008562 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008563
James Ketrenosafbf30a2005-08-25 00:05:33 -05008564 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8565 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008566
James Ketrenosafbf30a2005-08-25 00:05:33 -05008567 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8568 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8569 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008570
James Ketrenosafbf30a2005-08-25 00:05:33 -05008571 /* If power management is turned on, default to AC mode */
8572 priv->power_mode = IPW_POWER_AC;
8573 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008574
Zhu Yi0ece35b2005-08-05 17:26:51 +08008575 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008576}
8577
8578/*
8579 * This file defines the Wireless Extension handlers. It does not
8580 * define any methods of hardware manipulation and relies on the
8581 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008582 *
8583 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008584 * function used to poll the hardware vs. making unecessary calls.
8585 *
8586 */
8587
Jeff Garzikbf794512005-07-31 13:07:26 -04008588static int ipw_wx_get_name(struct net_device *dev,
8589 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008590 union iwreq_data *wrqu, char *extra)
8591{
8592 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008593 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008594 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008595 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008596 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008597 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008598 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008599 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8600 ipw_modes[priv->assoc_request.ieee_mode]);
8601 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008602 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008603 return 0;
8604}
8605
8606static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8607{
8608 if (channel == 0) {
8609 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8610 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008611 IPW_DEBUG_ASSOC("Attempting to associate with new "
8612 "parameters.\n");
8613 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008614 return 0;
8615 }
8616
8617 priv->config |= CFG_STATIC_CHANNEL;
8618
8619 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008620 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8621 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008622 return 0;
8623 }
8624
8625 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8626 priv->channel = channel;
8627
James Ketrenosb095c382005-08-24 22:04:42 -05008628#ifdef CONFIG_IPW2200_MONITOR
8629 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008630 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008631 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008632 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008633 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008634 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008635 }
8636
8637 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8638 udelay(10);
8639
8640 if (priv->status & STATUS_SCANNING)
8641 IPW_DEBUG_SCAN("Still scanning...\n");
8642 else
8643 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8644 1000 - i);
8645
8646 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008647 }
James Ketrenosb095c382005-08-24 22:04:42 -05008648#endif /* CONFIG_IPW2200_MONITOR */
8649
James Ketrenosc848d0a2005-08-24 21:56:24 -05008650 /* Network configuration changed -- force [re]association */
8651 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8652 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008653 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008654
8655 return 0;
8656}
8657
Jeff Garzikbf794512005-07-31 13:07:26 -04008658static int ipw_wx_set_freq(struct net_device *dev,
8659 struct iw_request_info *info,
8660 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008661{
8662 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008663 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008664 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008665 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008666 u8 channel, flags;
8667 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008668
James Ketrenosb095c382005-08-24 22:04:42 -05008669 if (fwrq->m == 0) {
8670 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008671 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008672 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008673 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008674 return ret;
8675 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008676 /* if setting by freq convert to channel */
8677 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008678 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008679 if (channel == 0)
8680 return -EINVAL;
8681 } else
8682 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008683
Larry Finger1867b112006-02-28 09:48:28 -06008684 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008685 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008686
Liu Hong1fe0adb2005-08-19 09:33:10 -05008687 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008688 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008689 if (i == -1)
8690 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008691
8692 flags = (band == IEEE80211_24GHZ_BAND) ?
8693 geo->bg[i].flags : geo->a[i].flags;
8694 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008695 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8696 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008697 }
8698 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008699
James Ketrenos43f66a62005-03-25 12:31:53 -06008700 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008701 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008702 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008703 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008704 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008705}
8706
Jeff Garzikbf794512005-07-31 13:07:26 -04008707static int ipw_wx_get_freq(struct net_device *dev,
8708 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008709 union iwreq_data *wrqu, char *extra)
8710{
8711 struct ipw_priv *priv = ieee80211_priv(dev);
8712
8713 wrqu->freq.e = 0;
8714
8715 /* If we are associated, trying to associate, or have a statically
8716 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008717 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008718 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008719 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8720 int i;
8721
8722 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8723 BUG_ON(i == -1);
8724 wrqu->freq.e = 1;
8725
8726 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8727 case IEEE80211_52GHZ_BAND:
8728 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8729 break;
8730
8731 case IEEE80211_24GHZ_BAND:
8732 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8733 break;
8734
8735 default:
8736 BUG();
8737 }
8738 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008739 wrqu->freq.m = 0;
8740
Zhu Yi46441512006-01-24 16:37:59 +08008741 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008742 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8743 return 0;
8744}
8745
Jeff Garzikbf794512005-07-31 13:07:26 -04008746static int ipw_wx_set_mode(struct net_device *dev,
8747 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008748 union iwreq_data *wrqu, char *extra)
8749{
8750 struct ipw_priv *priv = ieee80211_priv(dev);
8751 int err = 0;
8752
8753 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8754
James Ketrenos43f66a62005-03-25 12:31:53 -06008755 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008756#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008757 case IW_MODE_MONITOR:
8758#endif
8759 case IW_MODE_ADHOC:
8760 case IW_MODE_INFRA:
8761 break;
8762 case IW_MODE_AUTO:
8763 wrqu->mode = IW_MODE_INFRA;
8764 break;
8765 default:
8766 return -EINVAL;
8767 }
James Ketrenosb095c382005-08-24 22:04:42 -05008768 if (wrqu->mode == priv->ieee->iw_mode)
8769 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008770
Zhu Yi46441512006-01-24 16:37:59 +08008771 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008772
8773 ipw_sw_reset(priv, 0);
8774
James Ketrenosb095c382005-08-24 22:04:42 -05008775#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008776 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008777 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008778
8779 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008780#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008781 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8782#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008783 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008784#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008785#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008786
Jeff Garzikbf794512005-07-31 13:07:26 -04008787 /* Free the existing firmware and reset the fw_loaded
James Ketrenos43f66a62005-03-25 12:31:53 -06008788 * flag so ipw_load() will bring in the new firmawre */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008789 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008790
8791 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008792
James Ketrenosc848d0a2005-08-24 21:56:24 -05008793 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008794 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008795 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008796}
8797
Jeff Garzikbf794512005-07-31 13:07:26 -04008798static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008799 struct iw_request_info *info,
8800 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008801{
8802 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008803 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008804 wrqu->mode = priv->ieee->iw_mode;
8805 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008806 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008807 return 0;
8808}
8809
James Ketrenos43f66a62005-03-25 12:31:53 -06008810/* Values are in microsecond */
8811static const s32 timeout_duration[] = {
8812 350000,
8813 250000,
8814 75000,
8815 37000,
8816 25000,
8817};
8818
8819static const s32 period_duration[] = {
8820 400000,
8821 700000,
8822 1000000,
8823 1000000,
8824 1000000
8825};
8826
Jeff Garzikbf794512005-07-31 13:07:26 -04008827static int ipw_wx_get_range(struct net_device *dev,
8828 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008829 union iwreq_data *wrqu, char *extra)
8830{
8831 struct ipw_priv *priv = ieee80211_priv(dev);
8832 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008833 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008834 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008835
8836 wrqu->data.length = sizeof(*range);
8837 memset(range, 0, sizeof(*range));
8838
8839 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008840 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008841
8842 range->max_qual.qual = 100;
8843 /* TODO: Find real max RSSI and stick here */
8844 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008845 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008846 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008847
8848 range->avg_qual.qual = 70;
8849 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008850 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008851 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008852 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008853 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008854 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008855
Jeff Garzikbf794512005-07-31 13:07:26 -04008856 for (i = 0; i < range->num_bitrates; i++)
8857 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008858 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008859
James Ketrenos43f66a62005-03-25 12:31:53 -06008860 range->max_rts = DEFAULT_RTS_THRESHOLD;
8861 range->min_frag = MIN_FRAG_THRESHOLD;
8862 range->max_frag = MAX_FRAG_THRESHOLD;
8863
8864 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008865 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008866 range->num_encoding_sizes = 2;
8867 range->max_encoding_tokens = WEP_KEYS;
8868
8869 /* Set the Wireless Extension versions */
8870 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008871 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008872
James Ketrenosb095c382005-08-24 22:04:42 -05008873 i = 0;
8874 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008875 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8876 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8877 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8878 continue;
8879
James Ketrenosb095c382005-08-24 22:04:42 -05008880 range->freq[i].i = geo->bg[j].channel;
8881 range->freq[i].m = geo->bg[j].freq * 100000;
8882 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008883 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008884 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008885 }
James Ketrenosb095c382005-08-24 22:04:42 -05008886
8887 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008888 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8889 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8890 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8891 continue;
8892
James Ketrenosb095c382005-08-24 22:04:42 -05008893 range->freq[i].i = geo->a[j].channel;
8894 range->freq[i].m = geo->a[j].freq * 100000;
8895 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008896 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008897 }
8898 }
8899
8900 range->num_channels = i;
8901 range->num_frequency = i;
8902
Zhu Yi46441512006-01-24 16:37:59 +08008903 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008904
8905 /* Event capability (kernel + driver) */
8906 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8907 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008908 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8909 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008910 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008911
Dan Williamsf1b50862006-01-30 13:58:56 -05008912 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8913 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8914
Dan Williams374fdfb2007-12-12 10:25:07 -05008915 range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE;
8916
James Ketrenos43f66a62005-03-25 12:31:53 -06008917 IPW_DEBUG_WX("GET Range\n");
8918 return 0;
8919}
8920
Jeff Garzikbf794512005-07-31 13:07:26 -04008921static int ipw_wx_set_wap(struct net_device *dev,
8922 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008923 union iwreq_data *wrqu, char *extra)
8924{
8925 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07008926 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06008927
8928 static const unsigned char any[] = {
8929 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8930 };
8931 static const unsigned char off[] = {
8932 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8933 };
8934
Jeff Garzikbf794512005-07-31 13:07:26 -04008935 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008936 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008937 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008938 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8939 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8940 /* we disable mandatory BSSID association */
8941 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8942 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008943 IPW_DEBUG_ASSOC("Attempting to associate with new "
8944 "parameters.\n");
8945 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08008946 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008947 return 0;
8948 }
8949
8950 priv->config |= CFG_STATIC_BSSID;
8951 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8952 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008953 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008954 return 0;
8955 }
8956
Joe Perches0795af52007-10-03 17:59:30 -07008957 IPW_DEBUG_WX("Setting mandatory BSSID to %s\n",
8958 print_mac(mac, wrqu->ap_addr.sa_data));
James Ketrenos43f66a62005-03-25 12:31:53 -06008959
8960 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
8961
James Ketrenosc848d0a2005-08-24 21:56:24 -05008962 /* Network configuration changed -- force [re]association */
8963 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
8964 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008965 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008966
Zhu Yi46441512006-01-24 16:37:59 +08008967 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008968 return 0;
8969}
8970
Jeff Garzikbf794512005-07-31 13:07:26 -04008971static int ipw_wx_get_wap(struct net_device *dev,
8972 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008973 union iwreq_data *wrqu, char *extra)
8974{
8975 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07008976 DECLARE_MAC_BUF(mac);
8977
James Ketrenos43f66a62005-03-25 12:31:53 -06008978 /* If we are associated, trying to associate, or have a statically
8979 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008980 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04008981 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06008982 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8983 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008984 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06008985 } else
8986 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8987
Joe Perches0795af52007-10-03 17:59:30 -07008988 IPW_DEBUG_WX("Getting WAP BSSID: %s\n",
8989 print_mac(mac, wrqu->ap_addr.sa_data));
Zhu Yi46441512006-01-24 16:37:59 +08008990 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008991 return 0;
8992}
8993
Jeff Garzikbf794512005-07-31 13:07:26 -04008994static int ipw_wx_set_essid(struct net_device *dev,
8995 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008996 union iwreq_data *wrqu, char *extra)
8997{
8998 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08008999 int length;
James Ketrenos43f66a62005-03-25 12:31:53 -06009000
Zhu Yiab644b02006-08-21 11:37:13 +08009001 mutex_lock(&priv->mutex);
9002
9003 if (!wrqu->essid.flags)
9004 {
9005 IPW_DEBUG_WX("Setting ESSID to ANY\n");
9006 ipw_disassociate(priv);
9007 priv->config &= ~CFG_STATIC_ESSID;
9008 ipw_associate(priv);
9009 mutex_unlock(&priv->mutex);
9010 return 0;
9011 }
9012
Zhu Yia9f0d422006-08-21 11:37:26 +08009013 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06009014
9015 priv->config |= CFG_STATIC_ESSID;
9016
Zhu Yia9f0d422006-08-21 11:37:26 +08009017 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
9018 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009019 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009020 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009021 return 0;
9022 }
9023
Zhu Yiab644b02006-08-21 11:37:13 +08009024 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n", escape_essid(extra, length),
James Ketrenos43f66a62005-03-25 12:31:53 -06009025 length);
9026
9027 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08009028 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04009029
James Ketrenosc848d0a2005-08-24 21:56:24 -05009030 /* Network configuration changed -- force [re]association */
9031 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
9032 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009033 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009034
Zhu Yi46441512006-01-24 16:37:59 +08009035 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009036 return 0;
9037}
9038
Jeff Garzikbf794512005-07-31 13:07:26 -04009039static int ipw_wx_get_essid(struct net_device *dev,
9040 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009041 union iwreq_data *wrqu, char *extra)
9042{
9043 struct ipw_priv *priv = ieee80211_priv(dev);
9044
9045 /* If we are associated, trying to associate, or have a statically
9046 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009047 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009048 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04009049 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9050 IPW_DEBUG_WX("Getting essid: '%s'\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009051 escape_essid(priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04009052 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06009053 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009054 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009055 } else {
9056 IPW_DEBUG_WX("Getting essid: ANY\n");
9057 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009058 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009059 }
Zhu Yi46441512006-01-24 16:37:59 +08009060 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009061 return 0;
9062}
9063
Jeff Garzikbf794512005-07-31 13:07:26 -04009064static int ipw_wx_set_nick(struct net_device *dev,
9065 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009066 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009067{
James Ketrenos43f66a62005-03-25 12:31:53 -06009068 struct ipw_priv *priv = ieee80211_priv(dev);
9069
9070 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
9071 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
9072 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08009073 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009074 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06009075 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009076 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009077 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08009078 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009079 return 0;
9080
9081}
9082
Jeff Garzikbf794512005-07-31 13:07:26 -04009083static int ipw_wx_get_nick(struct net_device *dev,
9084 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009085 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009086{
James Ketrenos43f66a62005-03-25 12:31:53 -06009087 struct ipw_priv *priv = ieee80211_priv(dev);
9088 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08009089 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009090 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06009091 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009092 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08009093 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009094 return 0;
9095}
9096
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009097static int ipw_wx_set_sens(struct net_device *dev,
9098 struct iw_request_info *info,
9099 union iwreq_data *wrqu, char *extra)
9100{
9101 struct ipw_priv *priv = ieee80211_priv(dev);
9102 int err = 0;
9103
9104 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
9105 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
9106 mutex_lock(&priv->mutex);
9107
9108 if (wrqu->sens.fixed == 0)
9109 {
9110 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
9111 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
9112 goto out;
9113 }
9114 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
9115 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
9116 err = -EINVAL;
9117 goto out;
9118 }
9119
9120 priv->roaming_threshold = wrqu->sens.value;
9121 priv->disassociate_threshold = 3*wrqu->sens.value;
9122 out:
9123 mutex_unlock(&priv->mutex);
9124 return err;
9125}
9126
9127static int ipw_wx_get_sens(struct net_device *dev,
9128 struct iw_request_info *info,
9129 union iwreq_data *wrqu, char *extra)
9130{
9131 struct ipw_priv *priv = ieee80211_priv(dev);
9132 mutex_lock(&priv->mutex);
9133 wrqu->sens.fixed = 1;
9134 wrqu->sens.value = priv->roaming_threshold;
9135 mutex_unlock(&priv->mutex);
9136
9137 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9138 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9139
9140 return 0;
9141}
9142
James Ketrenos43f66a62005-03-25 12:31:53 -06009143static int ipw_wx_set_rate(struct net_device *dev,
9144 struct iw_request_info *info,
9145 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009146{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009147 /* TODO: We should use semaphores or locks for access to priv */
9148 struct ipw_priv *priv = ieee80211_priv(dev);
9149 u32 target_rate = wrqu->bitrate.value;
9150 u32 fixed, mask;
9151
9152 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9153 /* value = X, fixed = 1 means only rate X */
9154 /* value = X, fixed = 0 means all rates lower equal X */
9155
9156 if (target_rate == -1) {
9157 fixed = 0;
9158 mask = IEEE80211_DEFAULT_RATES_MASK;
9159 /* Now we should reassociate */
9160 goto apply;
9161 }
9162
9163 mask = 0;
9164 fixed = wrqu->bitrate.fixed;
9165
9166 if (target_rate == 1000000 || !fixed)
9167 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9168 if (target_rate == 1000000)
9169 goto apply;
9170
9171 if (target_rate == 2000000 || !fixed)
9172 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9173 if (target_rate == 2000000)
9174 goto apply;
9175
9176 if (target_rate == 5500000 || !fixed)
9177 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9178 if (target_rate == 5500000)
9179 goto apply;
9180
9181 if (target_rate == 6000000 || !fixed)
9182 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9183 if (target_rate == 6000000)
9184 goto apply;
9185
9186 if (target_rate == 9000000 || !fixed)
9187 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9188 if (target_rate == 9000000)
9189 goto apply;
9190
9191 if (target_rate == 11000000 || !fixed)
9192 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9193 if (target_rate == 11000000)
9194 goto apply;
9195
9196 if (target_rate == 12000000 || !fixed)
9197 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9198 if (target_rate == 12000000)
9199 goto apply;
9200
9201 if (target_rate == 18000000 || !fixed)
9202 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9203 if (target_rate == 18000000)
9204 goto apply;
9205
9206 if (target_rate == 24000000 || !fixed)
9207 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9208 if (target_rate == 24000000)
9209 goto apply;
9210
9211 if (target_rate == 36000000 || !fixed)
9212 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9213 if (target_rate == 36000000)
9214 goto apply;
9215
9216 if (target_rate == 48000000 || !fixed)
9217 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9218 if (target_rate == 48000000)
9219 goto apply;
9220
9221 if (target_rate == 54000000 || !fixed)
9222 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9223 if (target_rate == 54000000)
9224 goto apply;
9225
9226 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9227 return -EINVAL;
9228
9229 apply:
9230 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9231 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009232 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009233 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009234 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009235 ipw_set_fixed_rate(priv, priv->ieee->mode);
9236 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009237 priv->config |= CFG_FIXED_RATE;
9238
James Ketrenosc848d0a2005-08-24 21:56:24 -05009239 if (priv->rates_mask == mask) {
9240 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009241 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009242 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009243 }
9244
James Ketrenosc848d0a2005-08-24 21:56:24 -05009245 priv->rates_mask = mask;
9246
9247 /* Network configuration changed -- force [re]association */
9248 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9249 if (!ipw_disassociate(priv))
9250 ipw_associate(priv);
9251
Zhu Yi46441512006-01-24 16:37:59 +08009252 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009253 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009254}
9255
Jeff Garzikbf794512005-07-31 13:07:26 -04009256static int ipw_wx_get_rate(struct net_device *dev,
9257 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009258 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009259{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009260 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009261 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009262 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009263 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009264 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009265 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9266 return 0;
9267}
9268
Jeff Garzikbf794512005-07-31 13:07:26 -04009269static int ipw_wx_set_rts(struct net_device *dev,
9270 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009271 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009272{
James Ketrenos43f66a62005-03-25 12:31:53 -06009273 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009274 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009275 if (wrqu->rts.disabled || !wrqu->rts.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009276 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9277 else {
9278 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009279 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009280 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009281 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009282 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009283 priv->rts_threshold = wrqu->rts.value;
9284 }
9285
9286 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009287 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009288 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9289 return 0;
9290}
9291
Jeff Garzikbf794512005-07-31 13:07:26 -04009292static int ipw_wx_get_rts(struct net_device *dev,
9293 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009294 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009295{
James Ketrenos43f66a62005-03-25 12:31:53 -06009296 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009297 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009298 wrqu->rts.value = priv->rts_threshold;
9299 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009300 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009301 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009302 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9303 return 0;
9304}
9305
Jeff Garzikbf794512005-07-31 13:07:26 -04009306static int ipw_wx_set_txpow(struct net_device *dev,
9307 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009308 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009309{
James Ketrenos43f66a62005-03-25 12:31:53 -06009310 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009311 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009312
Zhu Yi46441512006-01-24 16:37:59 +08009313 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009314 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009315 err = -EINPROGRESS;
9316 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009317 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009318
James Ketrenosb095c382005-08-24 22:04:42 -05009319 if (!wrqu->power.fixed)
9320 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009321
James Ketrenosc848d0a2005-08-24 21:56:24 -05009322 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009323 err = -EINVAL;
9324 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009325 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009326
James Ketrenosb095c382005-08-24 22:04:42 -05009327 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009328 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009329 err = -EINVAL;
9330 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009331 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009332
9333 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009334 err = ipw_set_tx_power(priv);
9335 out:
Zhu Yi46441512006-01-24 16:37:59 +08009336 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009337 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009338}
9339
Jeff Garzikbf794512005-07-31 13:07:26 -04009340static int ipw_wx_get_txpow(struct net_device *dev,
9341 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009342 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009343{
James Ketrenos43f66a62005-03-25 12:31:53 -06009344 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009345 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009346 wrqu->power.value = priv->tx_power;
9347 wrqu->power.fixed = 1;
9348 wrqu->power.flags = IW_TXPOW_DBM;
9349 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009350 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009351
Jeff Garzikbf794512005-07-31 13:07:26 -04009352 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009353 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009354
9355 return 0;
9356}
9357
Jeff Garzikbf794512005-07-31 13:07:26 -04009358static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009359 struct iw_request_info *info,
9360 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009361{
9362 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009363 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009364 if (wrqu->frag.disabled || !wrqu->frag.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009365 priv->ieee->fts = DEFAULT_FTS;
9366 else {
9367 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009368 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009369 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009370 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009371 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009372
James Ketrenos43f66a62005-03-25 12:31:53 -06009373 priv->ieee->fts = wrqu->frag.value & ~0x1;
9374 }
9375
9376 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009377 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009378 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9379 return 0;
9380}
9381
Jeff Garzikbf794512005-07-31 13:07:26 -04009382static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009383 struct iw_request_info *info,
9384 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009385{
9386 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009387 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009388 wrqu->frag.value = priv->ieee->fts;
9389 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009390 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009391 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009392 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9393
9394 return 0;
9395}
9396
Jeff Garzikbf794512005-07-31 13:07:26 -04009397static int ipw_wx_set_retry(struct net_device *dev,
9398 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009399 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009400{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009401 struct ipw_priv *priv = ieee80211_priv(dev);
9402
9403 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9404 return -EINVAL;
9405
9406 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9407 return 0;
9408
Zhu Yid5f7ac22006-08-21 11:38:17 +08009409 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009410 return -EINVAL;
9411
Zhu Yi46441512006-01-24 16:37:59 +08009412 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009413 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009414 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009415 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009416 priv->long_retry_limit = (u8) wrqu->retry.value;
9417 else {
9418 priv->short_retry_limit = (u8) wrqu->retry.value;
9419 priv->long_retry_limit = (u8) wrqu->retry.value;
9420 }
9421
9422 ipw_send_retry_limit(priv, priv->short_retry_limit,
9423 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009424 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009425 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9426 priv->short_retry_limit, priv->long_retry_limit);
9427 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009428}
9429
Jeff Garzikbf794512005-07-31 13:07:26 -04009430static int ipw_wx_get_retry(struct net_device *dev,
9431 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009432 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009433{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009434 struct ipw_priv *priv = ieee80211_priv(dev);
9435
Zhu Yi46441512006-01-24 16:37:59 +08009436 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009437 wrqu->retry.disabled = 0;
9438
9439 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009440 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009441 return -EINVAL;
9442 }
9443
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009444 if (wrqu->retry.flags & IW_RETRY_LONG) {
9445 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009446 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009447 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9448 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009449 wrqu->retry.value = priv->short_retry_limit;
9450 } else {
9451 wrqu->retry.flags = IW_RETRY_LIMIT;
9452 wrqu->retry.value = priv->short_retry_limit;
9453 }
Zhu Yi46441512006-01-24 16:37:59 +08009454 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009455
9456 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9457
9458 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009459}
9460
James Ketrenosafbf30a2005-08-25 00:05:33 -05009461static int ipw_request_direct_scan(struct ipw_priv *priv, char *essid,
9462 int essid_len)
9463{
9464 struct ipw_scan_request_ext scan;
9465 int err = 0, scan_type;
9466
Pekka Enbergefb34422005-11-16 21:55:05 +02009467 if (!(priv->status & STATUS_INIT) ||
9468 (priv->status & STATUS_EXIT_PENDING))
9469 return 0;
9470
Zhu Yi46441512006-01-24 16:37:59 +08009471 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009472
9473 if (priv->status & STATUS_RF_KILL_MASK) {
9474 IPW_DEBUG_HC("Aborting scan due to RF kill activation\n");
9475 priv->status |= STATUS_SCAN_PENDING;
9476 goto done;
9477 }
9478
9479 IPW_DEBUG_HC("starting request direct scan!\n");
9480
9481 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
Olaf Kirchd834a412006-01-09 17:00:37 +01009482 /* We should not sleep here; otherwise we will block most
9483 * of the system (for instance, we hold rtnl_lock when we
9484 * get here).
9485 */
9486 err = -EAGAIN;
9487 goto done;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009488 }
9489 memset(&scan, 0, sizeof(scan));
9490
9491 if (priv->config & CFG_SPEED_SCAN)
9492 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9493 cpu_to_le16(30);
9494 else
9495 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9496 cpu_to_le16(20);
9497
9498 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
9499 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05009500 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009501 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
9502
9503 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
9504
9505 err = ipw_send_ssid(priv, essid, essid_len);
9506 if (err) {
9507 IPW_DEBUG_HC("Attempt to send SSID command failed\n");
9508 goto done;
9509 }
9510 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
9511
9512 ipw_add_scan_channels(priv, &scan, scan_type);
9513
9514 err = ipw_send_scan_request_ext(priv, &scan);
9515 if (err) {
9516 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
9517 goto done;
9518 }
9519
9520 priv->status |= STATUS_SCANNING;
9521
9522 done:
Zhu Yi46441512006-01-24 16:37:59 +08009523 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009524 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009525}
9526
Jeff Garzikbf794512005-07-31 13:07:26 -04009527static int ipw_wx_set_scan(struct net_device *dev,
9528 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009529 union iwreq_data *wrqu, char *extra)
9530{
9531 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009532 struct iw_scan_req *req = (struct iw_scan_req *)extra;
9533
Dan Williams0b531672007-10-09 13:55:24 -04009534 mutex_lock(&priv->mutex);
9535 priv->user_requested_scan = 1;
9536 mutex_unlock(&priv->mutex);
9537
Zhu Yi094c4d22006-08-21 11:39:03 +08009538 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009539 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
9540 ipw_request_direct_scan(priv, req->essid,
9541 req->essid_len);
9542 return 0;
9543 }
Zhu Yi094c4d22006-08-21 11:39:03 +08009544 if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9545 queue_work(priv->workqueue,
9546 &priv->request_passive_scan);
9547 return 0;
9548 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05009549 }
James Ketrenos8935f392005-10-05 15:59:08 -05009550
James Ketrenos43f66a62005-03-25 12:31:53 -06009551 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009552
David Howellsc4028952006-11-22 14:57:56 +00009553 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05009554
James Ketrenos43f66a62005-03-25 12:31:53 -06009555 return 0;
9556}
9557
Jeff Garzikbf794512005-07-31 13:07:26 -04009558static int ipw_wx_get_scan(struct net_device *dev,
9559 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009560 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009561{
James Ketrenos43f66a62005-03-25 12:31:53 -06009562 struct ipw_priv *priv = ieee80211_priv(dev);
9563 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9564}
9565
Jeff Garzikbf794512005-07-31 13:07:26 -04009566static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009567 struct iw_request_info *info,
9568 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009569{
9570 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009571 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009572 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009573
Zhu Yi46441512006-01-24 16:37:59 +08009574 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009575 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009576
Hong Liucaeff812005-08-05 17:25:50 +08009577 /* In IBSS mode, we need to notify the firmware to update
9578 * the beacon info after we changed the capability. */
9579 if (cap != priv->capability &&
9580 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9581 priv->status & STATUS_ASSOCIATED)
9582 ipw_disassociate(priv);
9583
Zhu Yi46441512006-01-24 16:37:59 +08009584 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009585 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009586}
9587
Jeff Garzikbf794512005-07-31 13:07:26 -04009588static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009589 struct iw_request_info *info,
9590 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009591{
9592 struct ipw_priv *priv = ieee80211_priv(dev);
9593 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9594}
9595
Jeff Garzikbf794512005-07-31 13:07:26 -04009596static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009597 struct iw_request_info *info,
9598 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009599{
9600 struct ipw_priv *priv = ieee80211_priv(dev);
9601 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009602 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009603 if (wrqu->power.disabled) {
9604 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9605 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9606 if (err) {
9607 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009608 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009609 return err;
9610 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009611 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009612 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009613 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009614 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009615
9616 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009617 case IW_POWER_ON: /* If not specified */
9618 case IW_POWER_MODE: /* If set all mask */
Jean Delvarec03983a2007-10-19 23:22:55 +02009619 case IW_POWER_ALL_R: /* If explicitly state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009620 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009621 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009622 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9623 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009624 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009625 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009626 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009627
James Ketrenos43f66a62005-03-25 12:31:53 -06009628 /* If the user hasn't specified a power management mode yet, default
9629 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009630 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009631 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009632 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009633 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
Zhu Yi4e157f02007-07-12 16:09:32 +08009634
James Ketrenos43f66a62005-03-25 12:31:53 -06009635 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9636 if (err) {
9637 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009638 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009639 return err;
9640 }
9641
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009642 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009643 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009644 return 0;
9645}
9646
Jeff Garzikbf794512005-07-31 13:07:26 -04009647static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009648 struct iw_request_info *info,
9649 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009650{
9651 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009652 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009653 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009654 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009655 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009656 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009657
Zhu Yi46441512006-01-24 16:37:59 +08009658 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009659 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009660
James Ketrenos43f66a62005-03-25 12:31:53 -06009661 return 0;
9662}
9663
Jeff Garzikbf794512005-07-31 13:07:26 -04009664static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009665 struct iw_request_info *info,
9666 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009667{
9668 struct ipw_priv *priv = ieee80211_priv(dev);
9669 int mode = *(int *)extra;
9670 int err;
Zhu Yi4e157f02007-07-12 16:09:32 +08009671
Zhu Yi46441512006-01-24 16:37:59 +08009672 mutex_lock(&priv->mutex);
Zhu Yi4e157f02007-07-12 16:09:32 +08009673 if ((mode < 1) || (mode > IPW_POWER_LIMIT))
James Ketrenos43f66a62005-03-25 12:31:53 -06009674 mode = IPW_POWER_AC;
Jeff Garzikbf794512005-07-31 13:07:26 -04009675
Zhu Yi4e157f02007-07-12 16:09:32 +08009676 if (IPW_POWER_LEVEL(priv->power_mode) != mode) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009677 err = ipw_send_power_mode(priv, mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009678 if (err) {
9679 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009680 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009681 return err;
9682 }
Zhu Yi4e157f02007-07-12 16:09:32 +08009683 priv->power_mode = IPW_POWER_ENABLED | mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06009684 }
Zhu Yi46441512006-01-24 16:37:59 +08009685 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009686 return 0;
9687}
9688
9689#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009690static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009691 struct iw_request_info *info,
9692 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009693{
9694 struct ipw_priv *priv = ieee80211_priv(dev);
9695 int level = IPW_POWER_LEVEL(priv->power_mode);
9696 char *p = extra;
9697
9698 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9699
9700 switch (level) {
9701 case IPW_POWER_AC:
9702 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9703 break;
9704 case IPW_POWER_BATTERY:
9705 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9706 break;
9707 default:
9708 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009709 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009710 timeout_duration[level - 1] / 1000,
9711 period_duration[level - 1] / 1000);
9712 }
9713
9714 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009715 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009716
9717 wrqu->data.length = p - extra + 1;
9718
9719 return 0;
9720}
9721
9722static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009723 struct iw_request_info *info,
9724 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009725{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009726 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009727 int mode = *(int *)extra;
9728 u8 band = 0, modulation = 0;
9729
9730 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009731 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009732 return -EINVAL;
9733 }
Zhu Yi46441512006-01-24 16:37:59 +08009734 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009735 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009736 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009737 if (mode & IEEE_A) {
9738 band |= IEEE80211_52GHZ_BAND;
9739 modulation |= IEEE80211_OFDM_MODULATION;
9740 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009741 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009742 } else {
9743 if (mode & IEEE_A) {
9744 IPW_WARNING("Attempt to set 2200BG into "
9745 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009746 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009747 return -EINVAL;
9748 }
9749
James Ketrenosa33a1982005-09-14 14:28:59 -05009750 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009751 }
9752
9753 if (mode & IEEE_B) {
9754 band |= IEEE80211_24GHZ_BAND;
9755 modulation |= IEEE80211_CCK_MODULATION;
9756 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009757 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009758
James Ketrenos43f66a62005-03-25 12:31:53 -06009759 if (mode & IEEE_G) {
9760 band |= IEEE80211_24GHZ_BAND;
9761 modulation |= IEEE80211_OFDM_MODULATION;
9762 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009763 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009764
9765 priv->ieee->mode = mode;
9766 priv->ieee->freq_band = band;
9767 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009768 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009769
James Ketrenosc848d0a2005-08-24 21:56:24 -05009770 /* Network configuration changed -- force [re]association */
9771 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9772 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009773 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009774 ipw_associate(priv);
9775 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009776
James Ketrenosa613bff2005-08-24 21:43:11 -05009777 /* Update the band LEDs */
9778 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009779
Jeff Garzikbf794512005-07-31 13:07:26 -04009780 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009781 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009782 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009783 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009784 return 0;
9785}
9786
9787static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009788 struct iw_request_info *info,
9789 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009790{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009791 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009792 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009793 switch (priv->ieee->mode) {
9794 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009795 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9796 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009797 case IEEE_B:
9798 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9799 break;
9800 case IEEE_A | IEEE_B:
9801 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9802 break;
9803 case IEEE_G:
9804 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9805 break;
9806 case IEEE_A | IEEE_G:
9807 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9808 break;
9809 case IEEE_B | IEEE_G:
9810 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9811 break;
9812 case IEEE_A | IEEE_B | IEEE_G:
9813 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9814 break;
9815 default:
9816 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009817 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009818 }
9819
James Ketrenos43f66a62005-03-25 12:31:53 -06009820 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9821
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009822 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009823 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009824
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009825 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009826}
9827
James Ketrenosea2b26e2005-08-24 21:25:16 -05009828static int ipw_wx_set_preamble(struct net_device *dev,
9829 struct iw_request_info *info,
9830 union iwreq_data *wrqu, char *extra)
9831{
9832 struct ipw_priv *priv = ieee80211_priv(dev);
9833 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009834 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009835 /* Switching from SHORT -> LONG requires a disassociation */
9836 if (mode == 1) {
9837 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9838 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009839
9840 /* Network configuration changed -- force [re]association */
9841 IPW_DEBUG_ASSOC
9842 ("[re]association triggered due to preamble change.\n");
9843 if (!ipw_disassociate(priv))
9844 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009845 }
9846 goto done;
9847 }
9848
9849 if (mode == 0) {
9850 priv->config &= ~CFG_PREAMBLE_LONG;
9851 goto done;
9852 }
Zhu Yi46441512006-01-24 16:37:59 +08009853 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009854 return -EINVAL;
9855
9856 done:
Zhu Yi46441512006-01-24 16:37:59 +08009857 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009858 return 0;
9859}
9860
9861static int ipw_wx_get_preamble(struct net_device *dev,
9862 struct iw_request_info *info,
9863 union iwreq_data *wrqu, char *extra)
9864{
9865 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009866 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009867 if (priv->config & CFG_PREAMBLE_LONG)
9868 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9869 else
9870 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009871 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009872 return 0;
9873}
9874
James Ketrenosb095c382005-08-24 22:04:42 -05009875#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009876static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009877 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009878 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009879{
James Ketrenos43f66a62005-03-25 12:31:53 -06009880 struct ipw_priv *priv = ieee80211_priv(dev);
9881 int *parms = (int *)extra;
9882 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009883 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009884 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009885 if (enable) {
9886 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009887#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009888 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9889#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009890 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009891#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009892 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009893 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009894
James Ketrenos43f66a62005-03-25 12:31:53 -06009895 ipw_set_channel(priv, parms[1]);
9896 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009897 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009898 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009899 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009900 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009901 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009902 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009903 }
Zhu Yi46441512006-01-24 16:37:59 +08009904 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009905 return 0;
9906}
9907
Pavel Machek67fd6b42006-07-11 15:34:05 +02009908#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009909
Jeff Garzikbf794512005-07-31 13:07:26 -04009910static int ipw_wx_reset(struct net_device *dev,
9911 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009912 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009913{
James Ketrenos43f66a62005-03-25 12:31:53 -06009914 struct ipw_priv *priv = ieee80211_priv(dev);
9915 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009916 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009917 return 0;
9918}
James Ketrenosb095c382005-08-24 22:04:42 -05009919
James Ketrenosb095c382005-08-24 22:04:42 -05009920static int ipw_wx_sw_reset(struct net_device *dev,
9921 struct iw_request_info *info,
9922 union iwreq_data *wrqu, char *extra)
9923{
9924 struct ipw_priv *priv = ieee80211_priv(dev);
9925 union iwreq_data wrqu_sec = {
9926 .encoding = {
9927 .flags = IW_ENCODE_DISABLED,
9928 },
9929 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009930 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009931
9932 IPW_DEBUG_WX("SW_RESET\n");
9933
Zhu Yi46441512006-01-24 16:37:59 +08009934 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009935
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009936 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009937 if (!ret) {
9938 free_firmware();
9939 ipw_adapter_restart(priv);
9940 }
James Ketrenosb095c382005-08-24 22:04:42 -05009941
9942 /* The SW reset bit might have been toggled on by the 'disable'
9943 * module parameter, so take appropriate action */
9944 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9945
Zhu Yi46441512006-01-24 16:37:59 +08009946 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009947 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009948 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009949
9950 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9951 /* Configuration likely changed -- force [re]association */
9952 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9953 "reset.\n");
9954 if (!ipw_disassociate(priv))
9955 ipw_associate(priv);
9956 }
9957
Zhu Yi46441512006-01-24 16:37:59 +08009958 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009959
9960 return 0;
9961}
James Ketrenos43f66a62005-03-25 12:31:53 -06009962
9963/* Rebase the WE IOCTLs to zero for the handler array */
9964#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009965static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009966 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9967 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9968 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9969 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9970 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009971 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9972 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009973 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9974 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9975 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9976 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9977 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9978 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9979 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9980 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9981 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9982 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9983 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9984 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9985 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9986 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9987 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9988 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9989 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9990 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9991 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9992 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9993 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9994 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9995 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009996 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9997 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9998 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9999 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -050010000 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
10001 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
10002 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
10003 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
10004 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
10005 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
10006 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -060010007};
10008
James Ketrenosb095c382005-08-24 22:04:42 -050010009enum {
10010 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
10011 IPW_PRIV_GET_POWER,
10012 IPW_PRIV_SET_MODE,
10013 IPW_PRIV_GET_MODE,
10014 IPW_PRIV_SET_PREAMBLE,
10015 IPW_PRIV_GET_PREAMBLE,
10016 IPW_PRIV_RESET,
10017 IPW_PRIV_SW_RESET,
10018#ifdef CONFIG_IPW2200_MONITOR
10019 IPW_PRIV_SET_MONITOR,
10020#endif
10021};
James Ketrenos43f66a62005-03-25 12:31:53 -060010022
Jeff Garzikbf794512005-07-31 13:07:26 -040010023static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -060010024 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010025 .cmd = IPW_PRIV_SET_POWER,
10026 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10027 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010028 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010029 .cmd = IPW_PRIV_GET_POWER,
10030 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10031 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010032 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010033 .cmd = IPW_PRIV_SET_MODE,
10034 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10035 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010036 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010037 .cmd = IPW_PRIV_GET_MODE,
10038 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10039 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010040 {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010041 .cmd = IPW_PRIV_SET_PREAMBLE,
10042 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10043 .name = "set_preamble"},
10044 {
10045 .cmd = IPW_PRIV_GET_PREAMBLE,
10046 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
10047 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010048 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010049 IPW_PRIV_RESET,
10050 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -050010051 {
10052 IPW_PRIV_SW_RESET,
10053 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
10054#ifdef CONFIG_IPW2200_MONITOR
10055 {
10056 IPW_PRIV_SET_MONITOR,
10057 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
10058#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -060010059};
10060
10061static iw_handler ipw_priv_handler[] = {
10062 ipw_wx_set_powermode,
10063 ipw_wx_get_powermode,
10064 ipw_wx_set_wireless_mode,
10065 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -050010066 ipw_wx_set_preamble,
10067 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -040010068 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -050010069 ipw_wx_sw_reset,
10070#ifdef CONFIG_IPW2200_MONITOR
10071 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -060010072#endif
10073};
10074
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010075static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010076 .standard = ipw_wx_handlers,
10077 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
10078 .num_private = ARRAY_SIZE(ipw_priv_handler),
10079 .num_private_args = ARRAY_SIZE(ipw_priv_args),
10080 .private = ipw_priv_handler,
10081 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000010082 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -060010083};
10084
James Ketrenos43f66a62005-03-25 12:31:53 -060010085/*
10086 * Get wireless statistics.
10087 * Called by /proc/net/wireless
10088 * Also called by SIOCGIWSTATS
10089 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010090static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -060010091{
10092 struct ipw_priv *priv = ieee80211_priv(dev);
10093 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010094
James Ketrenos43f66a62005-03-25 12:31:53 -060010095 wstats = &priv->wstats;
10096
James Ketrenosea2b26e2005-08-24 21:25:16 -050010097 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -050010098 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -060010099 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
10100 * and associated; if not associcated, the values are all meaningless
10101 * anyway, so set them all to NULL and INVALID */
10102 if (!(priv->status & STATUS_ASSOCIATED)) {
10103 wstats->miss.beacon = 0;
10104 wstats->discard.retries = 0;
10105 wstats->qual.qual = 0;
10106 wstats->qual.level = 0;
10107 wstats->qual.noise = 0;
10108 wstats->qual.updated = 7;
10109 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010110 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -060010111 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010112 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010113
10114 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +080010115 wstats->qual.level = priv->exp_avg_rssi;
10116 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -060010117 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +080010118 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010119
10120 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
10121 wstats->discard.retries = priv->last_tx_failures;
10122 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -040010123
James Ketrenos43f66a62005-03-25 12:31:53 -060010124/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
10125 goto fail_get_ordinal;
10126 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -040010127
James Ketrenos43f66a62005-03-25 12:31:53 -060010128 return wstats;
10129}
10130
James Ketrenos43f66a62005-03-25 12:31:53 -060010131/* net device stuff */
10132
Arjan van de Ven858119e2006-01-14 13:20:43 -080010133static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -060010134{
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010135 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +080010136 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010137 sys_config->answer_broadcast_ssid_probe = 0;
10138 sys_config->accept_all_data_frames = 0;
10139 sys_config->accept_non_directed_frames = 1;
10140 sys_config->exclude_unicast_unencrypted = 0;
10141 sys_config->disable_unicast_decryption = 1;
10142 sys_config->exclude_multicast_unencrypted = 0;
10143 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010144 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10145 antenna = CFG_SYS_ANTENNA_BOTH;
10146 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010147 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010148 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010149 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010150 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010151 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010152 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010153}
10154
10155static int ipw_net_open(struct net_device *dev)
10156{
10157 struct ipw_priv *priv = ieee80211_priv(dev);
10158 IPW_DEBUG_INFO("dev->open\n");
10159 /* we should be verifying the device is ready to be opened */
Zhu Yi46441512006-01-24 16:37:59 +080010160 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -040010161 if (!(priv->status & STATUS_RF_KILL_MASK) &&
10162 (priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -060010163 netif_start_queue(dev);
Zhu Yi46441512006-01-24 16:37:59 +080010164 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010165 return 0;
10166}
10167
10168static int ipw_net_stop(struct net_device *dev)
10169{
10170 IPW_DEBUG_INFO("dev->close\n");
10171 netif_stop_queue(dev);
10172 return 0;
10173}
10174
10175/*
10176todo:
10177
10178modify to send one tfd per fragment instead of using chunking. otherwise
10179we need to heavily modify the ieee80211_skb_to_txb.
10180*/
10181
Arjan van de Ven858119e2006-01-14 13:20:43 -080010182static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010183 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010184{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010185 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010186 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010187 int i = 0;
10188 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010189#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010190 int tx_id = ipw_get_tx_queue_number(priv, pri);
10191 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10192#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010193 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010194#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010195 struct clx2_queue *q = &txq->q;
10196 u8 id, hdr_len, unicast;
10197 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010198 int fc;
Joe Perches0795af52007-10-03 17:59:30 -070010199 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -060010200
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010201 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010202 switch (priv->ieee->iw_mode) {
10203 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010204 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010205 id = ipw_find_station(priv, hdr->addr1);
10206 if (id == IPW_INVALID_STATION) {
10207 id = ipw_add_station(priv, hdr->addr1);
10208 if (id == IPW_INVALID_STATION) {
10209 IPW_WARNING("Attempt to send data to "
Joe Perches0795af52007-10-03 17:59:30 -070010210 "invalid cell: %s\n",
10211 print_mac(mac, hdr->addr1));
James Ketrenos43f66a62005-03-25 12:31:53 -060010212 goto drop;
10213 }
10214 }
10215 break;
10216
10217 case IW_MODE_INFRA:
10218 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010219 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010220 id = 0;
10221 break;
10222 }
10223
10224 tfd = &txq->bd[q->first_empty];
10225 txq->txb[q->first_empty] = txb;
10226 memset(tfd, 0, sizeof(*tfd));
10227 tfd->u.data.station_number = id;
10228
10229 tfd->control_flags.message_type = TX_FRAME_TYPE;
10230 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10231
10232 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010233 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010234 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010235
James Ketrenos43f66a62005-03-25 12:31:53 -060010236 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010237 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010238 else
James Ketrenosb095c382005-08-24 22:04:42 -050010239 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010240
James Ketrenosea2b26e2005-08-24 21:25:16 -050010241 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10242 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010243
James Ketrenosc848d0a2005-08-24 21:56:24 -050010244 fc = le16_to_cpu(hdr->frame_ctl);
10245 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010246
10247 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10248
James Ketrenosb095c382005-08-24 22:04:42 -050010249 if (likely(unicast))
10250 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10251
10252 if (txb->encrypted && !priv->ieee->host_encrypt) {
10253 switch (priv->ieee->sec.level) {
10254 case SEC_LEVEL_3:
10255 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010256 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010257 /* XXX: ACK flag must be set for CCMP even if it
10258 * is a multicast/broadcast packet, because CCMP
10259 * group communication encrypted by GTK is
10260 * actually done by the AP. */
10261 if (!unicast)
10262 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10263
10264 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10265 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10266 tfd->u.data.key_index = 0;
10267 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10268 break;
10269 case SEC_LEVEL_2:
10270 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010271 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010272 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10273 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10274 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10275 break;
10276 case SEC_LEVEL_1:
10277 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010278 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010279 tfd->u.data.key_index = priv->ieee->tx_keyidx;
10280 if (priv->ieee->sec.key_sizes[priv->ieee->tx_keyidx] <=
10281 40)
10282 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10283 else
10284 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10285 break;
10286 case SEC_LEVEL_0:
10287 break;
10288 default:
10289 printk(KERN_ERR "Unknow security level %d\n",
10290 priv->ieee->sec.level);
10291 break;
10292 }
10293 } else
10294 /* No hardware encryption */
10295 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10296
Zhu Yie43e3c12006-04-13 17:20:45 +080010297#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010298 if (fc & IEEE80211_STYPE_QOS_DATA)
10299 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010300#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010301
James Ketrenos43f66a62005-03-25 12:31:53 -060010302 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010303 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10304 txb->nr_frags));
10305 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10306 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10307 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10308 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10309 i, le32_to_cpu(tfd->u.data.num_chunks),
10310 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010311 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010312 i, tfd->u.data.num_chunks,
10313 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010314 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010315 txb->fragments[i]->len - hdr_len);
10316
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010317 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010318 cpu_to_le32(pci_map_single
10319 (priv->pci_dev,
10320 txb->fragments[i]->data + hdr_len,
10321 txb->fragments[i]->len - hdr_len,
10322 PCI_DMA_TODEVICE));
10323 tfd->u.data.chunk_len[i] =
10324 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010325 }
10326
10327 if (i != txb->nr_frags) {
10328 struct sk_buff *skb;
10329 u16 remaining_bytes = 0;
10330 int j;
10331
10332 for (j = i; j < txb->nr_frags; j++)
10333 remaining_bytes += txb->fragments[j]->len - hdr_len;
10334
10335 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10336 remaining_bytes);
10337 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10338 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010339 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010340 for (j = i; j < txb->nr_frags; j++) {
10341 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010342
James Ketrenos43f66a62005-03-25 12:31:53 -060010343 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010344 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010345 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010346 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010347 }
10348 dev_kfree_skb_any(txb->fragments[i]);
10349 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010350 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010351 cpu_to_le32(pci_map_single
10352 (priv->pci_dev, skb->data,
10353 tfd->u.data.chunk_len[i],
10354 PCI_DMA_TODEVICE));
10355
10356 tfd->u.data.num_chunks =
10357 cpu_to_le32(le32_to_cpu(tfd->u.data.num_chunks) +
10358 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010359 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010360 }
10361
10362 /* kick DMA */
10363 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10364 ipw_write32(priv, q->reg_w, q->first_empty);
10365
James Ketrenosf6970142006-02-14 09:10:51 +080010366 if (ipw_queue_space(q) < q->high_mark)
10367 netif_stop_queue(priv->net_dev);
10368
James Ketrenos227d2dc2005-07-28 16:25:55 -050010369 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010370
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010371 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010372 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10373 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010374 return NETDEV_TX_OK;
10375}
10376
10377static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10378{
10379 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010380#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010381 int tx_id = ipw_get_tx_queue_number(priv, pri);
10382 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10383#else
10384 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010385#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010386
10387 if (ipw_queue_space(&txq->q) < txq->q.high_mark)
10388 return 1;
10389
10390 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010391}
10392
Zhu Yid685b8c2006-04-13 17:20:27 +080010393#ifdef CONFIG_IPW2200_PROMISCUOUS
10394static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10395 struct ieee80211_txb *txb)
10396{
10397 struct ieee80211_rx_stats dummystats;
10398 struct ieee80211_hdr *hdr;
10399 u8 n;
10400 u16 filter = priv->prom_priv->filter;
10401 int hdr_only = 0;
10402
10403 if (filter & IPW_PROM_NO_TX)
10404 return;
10405
10406 memset(&dummystats, 0, sizeof(dummystats));
10407
10408 /* Filtering of fragment chains is done agains the first fragment */
10409 hdr = (void *)txb->fragments[0]->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010410 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010411 if (filter & IPW_PROM_NO_MGMT)
10412 return;
10413 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10414 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010415 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010416 if (filter & IPW_PROM_NO_CTL)
10417 return;
10418 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10419 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010420 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010421 if (filter & IPW_PROM_NO_DATA)
10422 return;
10423 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10424 hdr_only = 1;
10425 }
10426
10427 for(n=0; n<txb->nr_frags; ++n) {
10428 struct sk_buff *src = txb->fragments[n];
10429 struct sk_buff *dst;
10430 struct ieee80211_radiotap_header *rt_hdr;
10431 int len;
10432
10433 if (hdr_only) {
10434 hdr = (void *)src->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010435 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +080010436 } else
10437 len = src->len;
10438
10439 dst = alloc_skb(
10440 len + IEEE80211_RADIOTAP_HDRLEN, GFP_ATOMIC);
10441 if (!dst) continue;
10442
10443 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10444
10445 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10446 rt_hdr->it_pad = 0;
10447 rt_hdr->it_present = 0; /* after all, it's just an idea */
10448 rt_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL);
10449
10450 *(u16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
10451 ieee80211chan2mhz(priv->channel));
10452 if (priv->channel > 14) /* 802.11a */
10453 *(u16*)skb_put(dst, sizeof(u16)) =
10454 cpu_to_le16(IEEE80211_CHAN_OFDM |
10455 IEEE80211_CHAN_5GHZ);
10456 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
10457 *(u16*)skb_put(dst, sizeof(u16)) =
10458 cpu_to_le16(IEEE80211_CHAN_CCK |
10459 IEEE80211_CHAN_2GHZ);
10460 else /* 802.11g */
10461 *(u16*)skb_put(dst, sizeof(u16)) =
10462 cpu_to_le16(IEEE80211_CHAN_OFDM |
10463 IEEE80211_CHAN_2GHZ);
10464
10465 rt_hdr->it_len = dst->len;
10466
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -030010467 skb_copy_from_linear_data(src, skb_put(dst, len), len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010468
10469 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10470 dev_kfree_skb_any(dst);
10471 }
10472}
10473#endif
10474
James Ketrenos43f66a62005-03-25 12:31:53 -060010475static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010476 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010477{
10478 struct ipw_priv *priv = ieee80211_priv(dev);
10479 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010480 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010481
10482 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010483 spin_lock_irqsave(&priv->lock, flags);
10484
10485 if (!(priv->status & STATUS_ASSOCIATED)) {
10486 IPW_DEBUG_INFO("Tx attempt while not associated.\n");
10487 priv->ieee->stats.tx_carrier_errors++;
10488 netif_stop_queue(dev);
10489 goto fail_unlock;
10490 }
10491
Zhu Yid685b8c2006-04-13 17:20:27 +080010492#ifdef CONFIG_IPW2200_PROMISCUOUS
10493 if (rtap_iface && netif_running(priv->prom_net_dev))
10494 ipw_handle_promiscuous_tx(priv, txb);
10495#endif
10496
James Ketrenos227d2dc2005-07-28 16:25:55 -050010497 ret = ipw_tx_skb(priv, txb, pri);
10498 if (ret == NETDEV_TX_OK)
10499 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010500 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010501
James Ketrenos227d2dc2005-07-28 16:25:55 -050010502 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010503
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010504 fail_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010505 spin_unlock_irqrestore(&priv->lock, flags);
10506 return 1;
10507}
10508
10509static struct net_device_stats *ipw_net_get_stats(struct net_device *dev)
10510{
10511 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzikbf794512005-07-31 13:07:26 -040010512
James Ketrenos43f66a62005-03-25 12:31:53 -060010513 priv->ieee->stats.tx_packets = priv->tx_packets;
10514 priv->ieee->stats.rx_packets = priv->rx_packets;
10515 return &priv->ieee->stats;
10516}
10517
10518static void ipw_net_set_multicast_list(struct net_device *dev)
10519{
10520
10521}
10522
10523static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10524{
10525 struct ipw_priv *priv = ieee80211_priv(dev);
10526 struct sockaddr *addr = p;
Joe Perches0795af52007-10-03 17:59:30 -070010527 DECLARE_MAC_BUF(mac);
10528
James Ketrenos43f66a62005-03-25 12:31:53 -060010529 if (!is_valid_ether_addr(addr->sa_data))
10530 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010531 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010532 priv->config |= CFG_CUSTOM_MAC;
10533 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
Joe Perches0795af52007-10-03 17:59:30 -070010534 printk(KERN_INFO "%s: Setting MAC to %s\n",
10535 priv->net_dev->name, print_mac(mac, priv->mac_addr));
James Ketrenosa613bff2005-08-24 21:43:11 -050010536 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010537 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010538 return 0;
10539}
10540
Jeff Garzikbf794512005-07-31 13:07:26 -040010541static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010542 struct ethtool_drvinfo *info)
10543{
10544 struct ipw_priv *p = ieee80211_priv(dev);
10545 char vers[64];
10546 char date[32];
10547 u32 len;
10548
10549 strcpy(info->driver, DRV_NAME);
10550 strcpy(info->version, DRV_VERSION);
10551
10552 len = sizeof(vers);
10553 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10554 len = sizeof(date);
10555 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10556
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010557 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010558 vers, date);
10559 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010560 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010561}
10562
10563static u32 ipw_ethtool_get_link(struct net_device *dev)
10564{
10565 struct ipw_priv *priv = ieee80211_priv(dev);
10566 return (priv->status & STATUS_ASSOCIATED) != 0;
10567}
10568
10569static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10570{
James Ketrenosb095c382005-08-24 22:04:42 -050010571 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010572}
10573
10574static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010575 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010576{
10577 struct ipw_priv *p = ieee80211_priv(dev);
10578
James Ketrenosb095c382005-08-24 22:04:42 -050010579 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010580 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010581 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010582 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010583 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010584 return 0;
10585}
10586
10587static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010588 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010589{
10590 struct ipw_priv *p = ieee80211_priv(dev);
10591 int i;
10592
James Ketrenosb095c382005-08-24 22:04:42 -050010593 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010594 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010595 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010596 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010597 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10598 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010599 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010600 return 0;
10601}
10602
Jeff Garzik7282d492006-09-13 14:30:00 -040010603static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010604 .get_link = ipw_ethtool_get_link,
10605 .get_drvinfo = ipw_ethtool_get_drvinfo,
10606 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10607 .get_eeprom = ipw_ethtool_get_eeprom,
10608 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010609};
10610
David Howells7d12e782006-10-05 14:55:46 +010010611static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010612{
10613 struct ipw_priv *priv = data;
10614 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010615
James Ketrenos43f66a62005-03-25 12:31:53 -060010616 if (!priv)
10617 return IRQ_NONE;
10618
Zhu Yi89c318e2006-06-08 22:19:49 -070010619 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010620
10621 if (!(priv->status & STATUS_INT_ENABLED)) {
Zhu Yid00d0122007-07-12 16:09:40 +080010622 /* IRQ is disabled */
James Ketrenos43f66a62005-03-25 12:31:53 -060010623 goto none;
10624 }
10625
James Ketrenosb095c382005-08-24 22:04:42 -050010626 inta = ipw_read32(priv, IPW_INTA_RW);
10627 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010628
James Ketrenos43f66a62005-03-25 12:31:53 -060010629 if (inta == 0xFFFFFFFF) {
10630 /* Hardware disappeared */
10631 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10632 goto none;
10633 }
10634
James Ketrenosb095c382005-08-24 22:04:42 -050010635 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010636 /* Shared interrupt */
10637 goto none;
10638 }
10639
10640 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010641 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010642
James Ketrenos43f66a62005-03-25 12:31:53 -060010643 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010644 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10645 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010646
James Ketrenos43f66a62005-03-25 12:31:53 -060010647 /* Cache INTA value for our tasklet */
10648 priv->isr_inta = inta;
10649
10650 tasklet_schedule(&priv->irq_tasklet);
10651
Zhu Yi89c318e2006-06-08 22:19:49 -070010652 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010653
10654 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010655 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010656 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010657 return IRQ_NONE;
10658}
10659
10660static void ipw_rf_kill(void *adapter)
10661{
10662 struct ipw_priv *priv = adapter;
10663 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010664
James Ketrenos43f66a62005-03-25 12:31:53 -060010665 spin_lock_irqsave(&priv->lock, flags);
10666
10667 if (rf_kill_active(priv)) {
10668 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10669 if (priv->workqueue)
10670 queue_delayed_work(priv->workqueue,
10671 &priv->rf_kill, 2 * HZ);
10672 goto exit_unlock;
10673 }
10674
10675 /* RF Kill is now disabled, so bring the device back up */
10676
10677 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10678 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10679 "device\n");
10680
10681 /* we can not do an adapter restart while inside an irq lock */
10682 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010683 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010684 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10685 "enabled\n");
10686
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010687 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010688 spin_unlock_irqrestore(&priv->lock, flags);
10689}
10690
David Howellsc4028952006-11-22 14:57:56 +000010691static void ipw_bg_rf_kill(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010692{
David Howellsc4028952006-11-22 14:57:56 +000010693 struct ipw_priv *priv =
10694 container_of(work, struct ipw_priv, rf_kill.work);
Zhu Yi46441512006-01-24 16:37:59 +080010695 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010696 ipw_rf_kill(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010697 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010698}
10699
Adrian Bunka73e22b2006-01-21 01:39:42 +010010700static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010701{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010702 priv->last_seq_num = -1;
10703 priv->last_frag_num = -1;
10704 priv->last_packet_time = 0;
10705
James Ketrenosa613bff2005-08-24 21:43:11 -050010706 netif_carrier_on(priv->net_dev);
10707 if (netif_queue_stopped(priv->net_dev)) {
10708 IPW_DEBUG_NOTIF("waking queue\n");
10709 netif_wake_queue(priv->net_dev);
10710 } else {
10711 IPW_DEBUG_NOTIF("starting queue\n");
10712 netif_start_queue(priv->net_dev);
10713 }
10714
James Ketrenosc848d0a2005-08-24 21:56:24 -050010715 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010716 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010717 ipw_reset_stats(priv);
10718 /* Ensure the rate is updated immediately */
10719 priv->last_rate = ipw_get_current_rate(priv);
10720 ipw_gather_stats(priv);
10721 ipw_led_link_up(priv);
10722 notify_wx_assoc_event(priv);
10723
10724 if (priv->config & CFG_BACKGROUND_SCAN)
10725 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10726}
10727
David Howellsc4028952006-11-22 14:57:56 +000010728static void ipw_bg_link_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010729{
David Howellsc4028952006-11-22 14:57:56 +000010730 struct ipw_priv *priv =
10731 container_of(work, struct ipw_priv, link_up);
Zhu Yi46441512006-01-24 16:37:59 +080010732 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010733 ipw_link_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010734 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010735}
10736
Adrian Bunka73e22b2006-01-21 01:39:42 +010010737static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010738{
10739 ipw_led_link_down(priv);
10740 netif_carrier_off(priv->net_dev);
10741 netif_stop_queue(priv->net_dev);
10742 notify_wx_assoc_event(priv);
10743
10744 /* Cancel any queued work ... */
10745 cancel_delayed_work(&priv->request_scan);
10746 cancel_delayed_work(&priv->adhoc_check);
10747 cancel_delayed_work(&priv->gather_stats);
10748
10749 ipw_reset_stats(priv);
10750
James Ketrenosafbf30a2005-08-25 00:05:33 -050010751 if (!(priv->status & STATUS_EXIT_PENDING)) {
10752 /* Queue up another scan... */
David Howellsc4028952006-11-22 14:57:56 +000010753 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
Dan Williams0b531672007-10-09 13:55:24 -040010754 } else
10755 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010756}
10757
David Howellsc4028952006-11-22 14:57:56 +000010758static void ipw_bg_link_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010759{
David Howellsc4028952006-11-22 14:57:56 +000010760 struct ipw_priv *priv =
10761 container_of(work, struct ipw_priv, link_down);
Zhu Yi46441512006-01-24 16:37:59 +080010762 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010763 ipw_link_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010764 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010765}
10766
Adrian Bunk2ef19e62007-12-11 23:20:22 +010010767static int __devinit ipw_setup_deferred_work(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010768{
10769 int ret = 0;
10770
James Ketrenos43f66a62005-03-25 12:31:53 -060010771 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010772 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010773 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010774
David Howellsc4028952006-11-22 14:57:56 +000010775 INIT_DELAYED_WORK(&priv->adhoc_check, ipw_bg_adhoc_check);
10776 INIT_WORK(&priv->associate, ipw_bg_associate);
10777 INIT_WORK(&priv->disassociate, ipw_bg_disassociate);
10778 INIT_WORK(&priv->system_config, ipw_system_config);
10779 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish);
10780 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart);
10781 INIT_DELAYED_WORK(&priv->rf_kill, ipw_bg_rf_kill);
10782 INIT_WORK(&priv->up, ipw_bg_up);
10783 INIT_WORK(&priv->down, ipw_bg_down);
10784 INIT_DELAYED_WORK(&priv->request_scan, ipw_request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010785 INIT_DELAYED_WORK(&priv->scan_event, ipw_scan_event);
David Howellsc4028952006-11-22 14:57:56 +000010786 INIT_WORK(&priv->request_passive_scan, ipw_request_passive_scan);
10787 INIT_DELAYED_WORK(&priv->gather_stats, ipw_bg_gather_stats);
10788 INIT_WORK(&priv->abort_scan, ipw_bg_abort_scan);
10789 INIT_WORK(&priv->roam, ipw_bg_roam);
10790 INIT_DELAYED_WORK(&priv->scan_check, ipw_bg_scan_check);
10791 INIT_WORK(&priv->link_up, ipw_bg_link_up);
10792 INIT_WORK(&priv->link_down, ipw_bg_link_down);
10793 INIT_DELAYED_WORK(&priv->led_link_on, ipw_bg_led_link_on);
10794 INIT_DELAYED_WORK(&priv->led_link_off, ipw_bg_led_link_off);
10795 INIT_DELAYED_WORK(&priv->led_act_off, ipw_bg_led_activity_off);
10796 INIT_WORK(&priv->merge_networks, ipw_merge_adhoc_network);
James Ketrenos43f66a62005-03-25 12:31:53 -060010797
Zhu Yie43e3c12006-04-13 17:20:45 +080010798#ifdef CONFIG_IPW2200_QOS
David Howellsc4028952006-11-22 14:57:56 +000010799 INIT_WORK(&priv->qos_activate, ipw_bg_qos_activate);
Zhu Yie43e3c12006-04-13 17:20:45 +080010800#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010801
10802 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10803 ipw_irq_tasklet, (unsigned long)priv);
10804
10805 return ret;
10806}
10807
James Ketrenos43f66a62005-03-25 12:31:53 -060010808static void shim__set_security(struct net_device *dev,
10809 struct ieee80211_security *sec)
10810{
10811 struct ipw_priv *priv = ieee80211_priv(dev);
10812 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010813 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010814 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010815 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010816 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010817 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010818 priv->ieee->sec.flags &= ~(1 << i);
10819 else {
10820 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010821 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010822 priv->ieee->sec.flags |= (1 << i);
10823 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010824 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010825 } else if (sec->level != SEC_LEVEL_1)
10826 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010827 }
10828
James Ketrenosb095c382005-08-24 22:04:42 -050010829 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010830 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010831 priv->ieee->sec.active_key = sec->active_key;
10832 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010833 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010834 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010835 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010836 } else
10837 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010838
10839 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010840 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10841 priv->ieee->sec.auth_mode = sec->auth_mode;
10842 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010843 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10844 priv->capability |= CAP_SHARED_KEY;
10845 else
10846 priv->capability &= ~CAP_SHARED_KEY;
10847 priv->status |= STATUS_SECURITY_UPDATED;
10848 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010849
James Ketrenosb095c382005-08-24 22:04:42 -050010850 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10851 priv->ieee->sec.flags |= SEC_ENABLED;
10852 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010853 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010854 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010855 priv->capability |= CAP_PRIVACY_ON;
10856 else
10857 priv->capability &= ~CAP_PRIVACY_ON;
10858 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010859
James Ketrenosafbf30a2005-08-25 00:05:33 -050010860 if (sec->flags & SEC_ENCRYPT)
10861 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010862
James Ketrenosb095c382005-08-24 22:04:42 -050010863 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10864 priv->ieee->sec.level = sec->level;
10865 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010866 priv->status |= STATUS_SECURITY_UPDATED;
10867 }
10868
Zhu Yi1fbfea52005-08-05 17:22:56 +080010869 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10870 ipw_set_hwcrypto_keys(priv);
10871
Jeff Garzikbf794512005-07-31 13:07:26 -040010872 /* To match current functionality of ipw2100 (which works well w/
10873 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010874 * privacy capability changes ... */
10875#if 0
10876 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010877 (((priv->assoc_request.capability &
James Ketrenos43f66a62005-03-25 12:31:53 -060010878 WLAN_CAPABILITY_PRIVACY) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010879 (!(priv->assoc_request.capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010880 WLAN_CAPABILITY_PRIVACY) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010881 IPW_DEBUG_ASSOC("Disassociating due to capability "
10882 "change.\n");
10883 ipw_disassociate(priv);
10884 }
10885#endif
10886}
10887
Jeff Garzikbf794512005-07-31 13:07:26 -040010888static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010889 struct ipw_supported_rates *rates)
10890{
10891 /* TODO: Mask out rates based on priv->rates_mask */
10892
10893 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010894 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010895 switch (priv->ieee->freq_band) {
10896 case IEEE80211_52GHZ_BAND:
10897 rates->ieee_mode = IPW_A_MODE;
10898 rates->purpose = IPW_RATE_CAPABILITIES;
10899 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10900 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10901 break;
10902
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010903 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010904 rates->ieee_mode = IPW_G_MODE;
10905 rates->purpose = IPW_RATE_CAPABILITIES;
10906 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10907 IEEE80211_CCK_DEFAULT_RATES_MASK);
10908 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10909 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10910 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10911 }
10912 break;
10913 }
10914
10915 return 0;
10916}
10917
Jeff Garzikbf794512005-07-31 13:07:26 -040010918static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010919{
James Ketrenos43f66a62005-03-25 12:31:53 -060010920 /* This is only called from ipw_up, which resets/reloads the firmware
10921 so, we don't need to first disable the card before we configure
10922 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010923 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010924 goto error;
10925
10926 /* initialize adapter address */
10927 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10928 goto error;
10929
10930 /* set basic system config settings */
10931 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010932
10933 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10934 * Does not support BT priority yet (don't abort or defer our Tx) */
10935 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010936 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010937
10938 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10939 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010940 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010941 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10942 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010943 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010944 }
10945
Zhu Yid685b8c2006-04-13 17:20:27 +080010946#ifdef CONFIG_IPW2200_PROMISCUOUS
10947 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10948 priv->sys_config.accept_all_data_frames = 1;
10949 priv->sys_config.accept_non_directed_frames = 1;
10950 priv->sys_config.accept_all_mgmt_bcpr = 1;
10951 priv->sys_config.accept_all_mgmt_frames = 1;
10952 }
10953#endif
10954
James Ketrenosc848d0a2005-08-24 21:56:24 -050010955 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10956 priv->sys_config.answer_broadcast_ssid_probe = 1;
10957 else
10958 priv->sys_config.answer_broadcast_ssid_probe = 0;
10959
Zhu Yid685b8c2006-04-13 17:20:27 +080010960 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010961 goto error;
10962
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010963 init_supported_rates(priv, &priv->rates);
10964 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010965 goto error;
10966
10967 /* Set request-to-send threshold */
10968 if (priv->rts_threshold) {
10969 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10970 goto error;
10971 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010972#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010973 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10974 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010975#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010976
10977 if (ipw_set_random_seed(priv))
10978 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010979
James Ketrenos43f66a62005-03-25 12:31:53 -060010980 /* final state transition to the RUN state */
10981 if (ipw_send_host_complete(priv))
10982 goto error;
10983
James Ketrenose6666192005-08-12 09:17:04 -050010984 priv->status |= STATUS_INIT;
10985
10986 ipw_led_init(priv);
10987 ipw_led_radio_on(priv);
10988 priv->notif_missed_beacons = 0;
10989
10990 /* Set hardware WEP key if it is configured. */
10991 if ((priv->capability & CAP_PRIVACY_ON) &&
10992 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10993 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10994 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010995
10996 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010997
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010998 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010999 return -EIO;
11000}
11001
James Ketrenos4f36f802005-08-03 20:36:56 -050011002/*
11003 * NOTE:
11004 *
11005 * These tables have been tested in conjunction with the
11006 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
11007 *
11008 * Altering this values, using it on other hardware, or in geographies
11009 * not intended for resale of the above mentioned Intel adapters has
11010 * not been tested.
11011 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011012 * Remember to update the table in README.ipw2200 when changing this
11013 * table.
11014 *
James Ketrenos4f36f802005-08-03 20:36:56 -050011015 */
11016static const struct ieee80211_geo ipw_geos[] = {
11017 { /* Restricted */
11018 "---",
11019 .bg_channels = 11,
11020 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11021 {2427, 4}, {2432, 5}, {2437, 6},
11022 {2442, 7}, {2447, 8}, {2452, 9},
11023 {2457, 10}, {2462, 11}},
11024 },
11025
11026 { /* Custom US/Canada */
11027 "ZZF",
11028 .bg_channels = 11,
11029 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11030 {2427, 4}, {2432, 5}, {2437, 6},
11031 {2442, 7}, {2447, 8}, {2452, 9},
11032 {2457, 10}, {2462, 11}},
11033 .a_channels = 8,
11034 .a = {{5180, 36},
11035 {5200, 40},
11036 {5220, 44},
11037 {5240, 48},
11038 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11039 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11040 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11041 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
11042 },
11043
11044 { /* Rest of World */
11045 "ZZD",
11046 .bg_channels = 13,
11047 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11048 {2427, 4}, {2432, 5}, {2437, 6},
11049 {2442, 7}, {2447, 8}, {2452, 9},
11050 {2457, 10}, {2462, 11}, {2467, 12},
11051 {2472, 13}},
11052 },
11053
11054 { /* Custom USA & Europe & High */
11055 "ZZA",
11056 .bg_channels = 11,
11057 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11058 {2427, 4}, {2432, 5}, {2437, 6},
11059 {2442, 7}, {2447, 8}, {2452, 9},
11060 {2457, 10}, {2462, 11}},
11061 .a_channels = 13,
11062 .a = {{5180, 36},
11063 {5200, 40},
11064 {5220, 44},
11065 {5240, 48},
11066 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11067 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11068 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11069 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11070 {5745, 149},
11071 {5765, 153},
11072 {5785, 157},
11073 {5805, 161},
11074 {5825, 165}},
11075 },
11076
11077 { /* Custom NA & Europe */
11078 "ZZB",
11079 .bg_channels = 11,
11080 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11081 {2427, 4}, {2432, 5}, {2437, 6},
11082 {2442, 7}, {2447, 8}, {2452, 9},
11083 {2457, 10}, {2462, 11}},
11084 .a_channels = 13,
11085 .a = {{5180, 36},
11086 {5200, 40},
11087 {5220, 44},
11088 {5240, 48},
11089 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11090 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11091 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11092 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11093 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11094 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11095 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11096 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11097 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11098 },
11099
11100 { /* Custom Japan */
11101 "ZZC",
11102 .bg_channels = 11,
11103 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11104 {2427, 4}, {2432, 5}, {2437, 6},
11105 {2442, 7}, {2447, 8}, {2452, 9},
11106 {2457, 10}, {2462, 11}},
11107 .a_channels = 4,
11108 .a = {{5170, 34}, {5190, 38},
11109 {5210, 42}, {5230, 46}},
11110 },
11111
11112 { /* Custom */
11113 "ZZM",
11114 .bg_channels = 11,
11115 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11116 {2427, 4}, {2432, 5}, {2437, 6},
11117 {2442, 7}, {2447, 8}, {2452, 9},
11118 {2457, 10}, {2462, 11}},
11119 },
11120
11121 { /* Europe */
11122 "ZZE",
11123 .bg_channels = 13,
11124 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11125 {2427, 4}, {2432, 5}, {2437, 6},
11126 {2442, 7}, {2447, 8}, {2452, 9},
11127 {2457, 10}, {2462, 11}, {2467, 12},
11128 {2472, 13}},
11129 .a_channels = 19,
11130 .a = {{5180, 36},
11131 {5200, 40},
11132 {5220, 44},
11133 {5240, 48},
11134 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11135 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11136 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11137 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11138 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11139 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11140 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11141 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11142 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11143 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11144 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11145 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11146 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11147 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11148 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11149 },
11150
11151 { /* Custom Japan */
11152 "ZZJ",
11153 .bg_channels = 14,
11154 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11155 {2427, 4}, {2432, 5}, {2437, 6},
11156 {2442, 7}, {2447, 8}, {2452, 9},
11157 {2457, 10}, {2462, 11}, {2467, 12},
11158 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11159 .a_channels = 4,
11160 .a = {{5170, 34}, {5190, 38},
11161 {5210, 42}, {5230, 46}},
11162 },
11163
James Ketrenos03520572005-10-19 16:12:31 -050011164 { /* Rest of World */
11165 "ZZR",
11166 .bg_channels = 14,
11167 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11168 {2427, 4}, {2432, 5}, {2437, 6},
11169 {2442, 7}, {2447, 8}, {2452, 9},
11170 {2457, 10}, {2462, 11}, {2467, 12},
11171 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11172 IEEE80211_CH_PASSIVE_ONLY}},
11173 },
11174
James Ketrenos4f36f802005-08-03 20:36:56 -050011175 { /* High Band */
11176 "ZZH",
11177 .bg_channels = 13,
11178 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11179 {2427, 4}, {2432, 5}, {2437, 6},
11180 {2442, 7}, {2447, 8}, {2452, 9},
11181 {2457, 10}, {2462, 11},
11182 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11183 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11184 .a_channels = 4,
11185 .a = {{5745, 149}, {5765, 153},
11186 {5785, 157}, {5805, 161}},
11187 },
11188
11189 { /* Custom Europe */
11190 "ZZG",
11191 .bg_channels = 13,
11192 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11193 {2427, 4}, {2432, 5}, {2437, 6},
11194 {2442, 7}, {2447, 8}, {2452, 9},
11195 {2457, 10}, {2462, 11},
11196 {2467, 12}, {2472, 13}},
11197 .a_channels = 4,
11198 .a = {{5180, 36}, {5200, 40},
11199 {5220, 44}, {5240, 48}},
11200 },
11201
11202 { /* Europe */
11203 "ZZK",
11204 .bg_channels = 13,
11205 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11206 {2427, 4}, {2432, 5}, {2437, 6},
11207 {2442, 7}, {2447, 8}, {2452, 9},
11208 {2457, 10}, {2462, 11},
11209 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11210 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11211 .a_channels = 24,
11212 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11213 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11214 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11215 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11216 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11217 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11218 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11219 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11220 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11221 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11222 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11223 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11224 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11225 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11226 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11227 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11228 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11229 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11230 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11231 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11232 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11233 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11234 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11235 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11236 },
11237
11238 { /* Europe */
11239 "ZZL",
11240 .bg_channels = 11,
11241 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11242 {2427, 4}, {2432, 5}, {2437, 6},
11243 {2442, 7}, {2447, 8}, {2452, 9},
11244 {2457, 10}, {2462, 11}},
11245 .a_channels = 13,
11246 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11247 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11248 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11249 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11250 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11251 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11252 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11253 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11254 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11255 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11256 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11257 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11258 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11259 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011260};
11261
James Ketrenos43f66a62005-03-25 12:31:53 -060011262#define MAX_HW_RESTARTS 5
11263static int ipw_up(struct ipw_priv *priv)
11264{
James Ketrenos4f36f802005-08-03 20:36:56 -050011265 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011266
11267 if (priv->status & STATUS_EXIT_PENDING)
11268 return -EIO;
11269
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011270 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011271 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011272 GFP_KERNEL);
11273 if (priv->cmdlog == NULL) {
11274 IPW_ERROR("Error allocating %d command log entries.\n",
11275 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011276 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011277 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011278 priv->cmdlog_len = cmdlog;
11279 }
11280 }
11281
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011282 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011283 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011284 * Also start the clocks. */
11285 rc = ipw_load(priv);
11286 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011287 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011288 return rc;
11289 }
11290
11291 ipw_init_ordinals(priv);
11292 if (!(priv->config & CFG_CUSTOM_MAC))
11293 eeprom_parse_mac(priv, priv->mac_addr);
11294 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11295
James Ketrenos4f36f802005-08-03 20:36:56 -050011296 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11297 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11298 ipw_geos[j].name, 3))
11299 break;
11300 }
James Ketrenos03520572005-10-19 16:12:31 -050011301 if (j == ARRAY_SIZE(ipw_geos)) {
11302 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11303 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11304 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11305 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011306 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011307 }
Larry Finger1867b112006-02-28 09:48:28 -060011308 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011309 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011310 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011311 }
11312
James Ketrenosb095c382005-08-24 22:04:42 -050011313 if (priv->status & STATUS_RF_KILL_SW) {
11314 IPW_WARNING("Radio disabled by module parameter.\n");
11315 return 0;
11316 } else if (rf_kill_active(priv)) {
11317 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11318 "Kill switch must be turned off for "
11319 "wireless networking to work.\n");
11320 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11321 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011322 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011323 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011324
11325 rc = ipw_config(priv);
11326 if (!rc) {
11327 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011328
James Ketrenose6666192005-08-12 09:17:04 -050011329 /* If configure to try and auto-associate, kick
11330 * off a scan. */
David Howellsc4028952006-11-22 14:57:56 +000011331 queue_delayed_work(priv->workqueue,
11332 &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011333
James Ketrenos43f66a62005-03-25 12:31:53 -060011334 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011335 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011336
James Ketrenosc848d0a2005-08-24 21:56:24 -050011337 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011338 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11339 i, MAX_HW_RESTARTS);
11340
11341 /* We had an error bringing up the hardware, so take it
11342 * all the way back down so we can try again */
11343 ipw_down(priv);
11344 }
11345
Jeff Garzikbf794512005-07-31 13:07:26 -040011346 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011347 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011348 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011349
James Ketrenos43f66a62005-03-25 12:31:53 -060011350 return -EIO;
11351}
11352
David Howellsc4028952006-11-22 14:57:56 +000011353static void ipw_bg_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011354{
David Howellsc4028952006-11-22 14:57:56 +000011355 struct ipw_priv *priv =
11356 container_of(work, struct ipw_priv, up);
Zhu Yi46441512006-01-24 16:37:59 +080011357 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011358 ipw_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011359 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011360}
11361
James Ketrenosb095c382005-08-24 22:04:42 -050011362static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011363{
James Ketrenosb095c382005-08-24 22:04:42 -050011364 int i;
11365
11366 if (priv->status & STATUS_SCANNING) {
11367 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11368 ipw_abort_scan(priv);
11369 }
11370
11371 if (priv->status & STATUS_ASSOCIATED) {
11372 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11373 ipw_disassociate(priv);
11374 }
11375
11376 ipw_led_shutdown(priv);
11377
11378 /* Wait up to 1s for status to change to not scanning and not
11379 * associated (disassociation can take a while for a ful 802.11
11380 * exchange */
11381 for (i = 1000; i && (priv->status &
11382 (STATUS_DISASSOCIATING |
11383 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11384 udelay(10);
11385
11386 if (priv->status & (STATUS_DISASSOCIATING |
11387 STATUS_ASSOCIATED | STATUS_SCANNING))
11388 IPW_DEBUG_INFO("Still associated or scanning...\n");
11389 else
11390 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11391
James Ketrenosc848d0a2005-08-24 21:56:24 -050011392 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011393 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011394
11395 priv->status &= ~STATUS_INIT;
11396}
11397
James Ketrenos43f66a62005-03-25 12:31:53 -060011398static void ipw_down(struct ipw_priv *priv)
11399{
James Ketrenosb095c382005-08-24 22:04:42 -050011400 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11401
11402 priv->status |= STATUS_EXIT_PENDING;
11403
11404 if (ipw_is_init(priv))
11405 ipw_deinit(priv);
11406
11407 /* Wipe out the EXIT_PENDING status bit if we are not actually
11408 * exiting the module */
11409 if (!exit_pending)
11410 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011411
11412 /* tell the device to stop sending interrupts */
11413 ipw_disable_interrupts(priv);
11414
11415 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011416 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011417 netif_carrier_off(priv->net_dev);
11418 netif_stop_queue(priv->net_dev);
11419
11420 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011421
11422 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011423}
11424
David Howellsc4028952006-11-22 14:57:56 +000011425static void ipw_bg_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011426{
David Howellsc4028952006-11-22 14:57:56 +000011427 struct ipw_priv *priv =
11428 container_of(work, struct ipw_priv, down);
Zhu Yi46441512006-01-24 16:37:59 +080011429 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011430 ipw_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011431 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011432}
11433
11434/* Called by register_netdev() */
11435static int ipw_net_init(struct net_device *dev)
11436{
11437 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011438 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011439
James Ketrenosc848d0a2005-08-24 21:56:24 -050011440 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011441 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011442 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011443 }
11444
Zhu Yi46441512006-01-24 16:37:59 +080011445 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011446 return 0;
11447}
11448
11449/* PCI driver stuff */
11450static struct pci_device_id card_ids[] = {
11451 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11452 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11453 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11454 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11455 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11456 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11457 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11458 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11459 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11460 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11461 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11462 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11463 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11464 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11465 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11466 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11467 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11468 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011469 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011470 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011471 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11472 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011473
James Ketrenos43f66a62005-03-25 12:31:53 -060011474 /* required last entry */
11475 {0,}
11476};
11477
11478MODULE_DEVICE_TABLE(pci, card_ids);
11479
11480static struct attribute *ipw_sysfs_entries[] = {
11481 &dev_attr_rf_kill.attr,
11482 &dev_attr_direct_dword.attr,
11483 &dev_attr_indirect_byte.attr,
11484 &dev_attr_indirect_dword.attr,
11485 &dev_attr_mem_gpio_reg.attr,
11486 &dev_attr_command_event_reg.attr,
11487 &dev_attr_nic_type.attr,
11488 &dev_attr_status.attr,
11489 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011490 &dev_attr_error.attr,
11491 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011492 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011493 &dev_attr_eeprom_delay.attr,
11494 &dev_attr_ucode_version.attr,
11495 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011496 &dev_attr_scan_age.attr,
11497 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011498 &dev_attr_speed_scan.attr,
11499 &dev_attr_net_stats.attr,
Zhu Yi375dd242007-02-14 16:04:24 +080011500 &dev_attr_channels.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011501#ifdef CONFIG_IPW2200_PROMISCUOUS
11502 &dev_attr_rtap_iface.attr,
11503 &dev_attr_rtap_filter.attr,
11504#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011505 NULL
11506};
11507
11508static struct attribute_group ipw_attribute_group = {
11509 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011510 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011511};
11512
Zhu Yid685b8c2006-04-13 17:20:27 +080011513#ifdef CONFIG_IPW2200_PROMISCUOUS
11514static int ipw_prom_open(struct net_device *dev)
11515{
11516 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11517 struct ipw_priv *priv = prom_priv->priv;
11518
11519 IPW_DEBUG_INFO("prom dev->open\n");
11520 netif_carrier_off(dev);
11521 netif_stop_queue(dev);
11522
11523 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11524 priv->sys_config.accept_all_data_frames = 1;
11525 priv->sys_config.accept_non_directed_frames = 1;
11526 priv->sys_config.accept_all_mgmt_bcpr = 1;
11527 priv->sys_config.accept_all_mgmt_frames = 1;
11528
11529 ipw_send_system_config(priv);
11530 }
11531
11532 return 0;
11533}
11534
11535static int ipw_prom_stop(struct net_device *dev)
11536{
11537 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11538 struct ipw_priv *priv = prom_priv->priv;
11539
11540 IPW_DEBUG_INFO("prom dev->stop\n");
11541
11542 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11543 priv->sys_config.accept_all_data_frames = 0;
11544 priv->sys_config.accept_non_directed_frames = 0;
11545 priv->sys_config.accept_all_mgmt_bcpr = 0;
11546 priv->sys_config.accept_all_mgmt_frames = 0;
11547
11548 ipw_send_system_config(priv);
11549 }
11550
11551 return 0;
11552}
11553
11554static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11555{
11556 IPW_DEBUG_INFO("prom dev->xmit\n");
11557 netif_stop_queue(dev);
11558 return -EOPNOTSUPP;
11559}
11560
11561static struct net_device_stats *ipw_prom_get_stats(struct net_device *dev)
11562{
11563 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11564 return &prom_priv->ieee->stats;
11565}
11566
11567static int ipw_prom_alloc(struct ipw_priv *priv)
11568{
11569 int rc = 0;
11570
11571 if (priv->prom_net_dev)
11572 return -EPERM;
11573
11574 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11575 if (priv->prom_net_dev == NULL)
11576 return -ENOMEM;
11577
11578 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11579 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11580 priv->prom_priv->priv = priv;
11581
11582 strcpy(priv->prom_net_dev->name, "rtap%d");
11583
11584 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
11585 priv->prom_net_dev->open = ipw_prom_open;
11586 priv->prom_net_dev->stop = ipw_prom_stop;
11587 priv->prom_net_dev->get_stats = ipw_prom_get_stats;
11588 priv->prom_net_dev->hard_start_xmit = ipw_prom_hard_start_xmit;
11589
11590 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
11591
11592 rc = register_netdev(priv->prom_net_dev);
11593 if (rc) {
11594 free_ieee80211(priv->prom_net_dev);
11595 priv->prom_net_dev = NULL;
11596 return rc;
11597 }
11598
11599 return 0;
11600}
11601
11602static void ipw_prom_free(struct ipw_priv *priv)
11603{
11604 if (!priv->prom_net_dev)
11605 return;
11606
11607 unregister_netdev(priv->prom_net_dev);
11608 free_ieee80211(priv->prom_net_dev);
11609
11610 priv->prom_net_dev = NULL;
11611}
11612
11613#endif
11614
11615
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011616static int __devinit ipw_pci_probe(struct pci_dev *pdev,
11617 const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011618{
11619 int err = 0;
11620 struct net_device *net_dev;
11621 void __iomem *base;
11622 u32 length, val;
11623 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011624 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011625
11626 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11627 if (net_dev == NULL) {
11628 err = -ENOMEM;
11629 goto out;
11630 }
11631
11632 priv = ieee80211_priv(net_dev);
11633 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011634
James Ketrenos43f66a62005-03-25 12:31:53 -060011635 priv->net_dev = net_dev;
11636 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011637 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011638 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011639 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011640 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11641 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011642
Zhu Yi46441512006-01-24 16:37:59 +080011643 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011644 if (pci_enable_device(pdev)) {
11645 err = -ENODEV;
11646 goto out_free_ieee80211;
11647 }
11648
11649 pci_set_master(pdev);
11650
Tobias Klauser0e08b442005-06-20 14:28:41 -070011651 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011652 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011653 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011654 if (err) {
11655 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11656 goto out_pci_disable_device;
11657 }
11658
11659 pci_set_drvdata(pdev, priv);
11660
11661 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011662 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011663 goto out_pci_disable_device;
11664
Jeff Garzikbf794512005-07-31 13:07:26 -040011665 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011666 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011667 pci_read_config_dword(pdev, 0x40, &val);
11668 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011669 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011670
James Ketrenos43f66a62005-03-25 12:31:53 -060011671 length = pci_resource_len(pdev, 0);
11672 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011673
James Ketrenos43f66a62005-03-25 12:31:53 -060011674 base = ioremap_nocache(pci_resource_start(pdev, 0), length);
11675 if (!base) {
11676 err = -ENODEV;
11677 goto out_pci_release_regions;
11678 }
11679
11680 priv->hw_base = base;
11681 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11682 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11683
11684 err = ipw_setup_deferred_work(priv);
11685 if (err) {
11686 IPW_ERROR("Unable to setup deferred work\n");
11687 goto out_iounmap;
11688 }
11689
James Ketrenosb095c382005-08-24 22:04:42 -050011690 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011691
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011692 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011693 if (err) {
11694 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11695 goto out_destroy_workqueue;
11696 }
11697
James Ketrenos43f66a62005-03-25 12:31:53 -060011698 SET_NETDEV_DEV(net_dev, &pdev->dev);
11699
Zhu Yi46441512006-01-24 16:37:59 +080011700 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011701
James Ketrenos43f66a62005-03-25 12:31:53 -060011702 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11703 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011704 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011705
Zhu Yie43e3c12006-04-13 17:20:45 +080011706#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011707 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011708 priv->ieee->handle_probe_response = ipw_handle_beacon;
11709 priv->ieee->handle_beacon = ipw_handle_probe_response;
11710 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011711#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011712
James Ketrenosc848d0a2005-08-24 21:56:24 -050011713 priv->ieee->perfect_rssi = -20;
11714 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011715
11716 net_dev->open = ipw_net_open;
11717 net_dev->stop = ipw_net_stop;
11718 net_dev->init = ipw_net_init;
11719 net_dev->get_stats = ipw_net_get_stats;
11720 net_dev->set_multicast_list = ipw_net_set_multicast_list;
11721 net_dev->set_mac_address = ipw_net_set_mac_address;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011722 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011723 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011724 net_dev->wireless_handlers = &ipw_wx_handler_def;
11725 net_dev->ethtool_ops = &ipw_ethtool_ops;
11726 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011727 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011728 net_dev->mem_start = pci_resource_start(pdev, 0);
11729 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11730
11731 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11732 if (err) {
11733 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011734 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011735 goto out_release_irq;
11736 }
11737
Zhu Yi46441512006-01-24 16:37:59 +080011738 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011739 err = register_netdev(net_dev);
11740 if (err) {
11741 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011742 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011743 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011744
Zhu Yid685b8c2006-04-13 17:20:27 +080011745#ifdef CONFIG_IPW2200_PROMISCUOUS
11746 if (rtap_iface) {
11747 err = ipw_prom_alloc(priv);
11748 if (err) {
11749 IPW_ERROR("Failed to register promiscuous network "
11750 "device (error %d).\n", err);
11751 unregister_netdev(priv->net_dev);
11752 goto out_remove_sysfs;
11753 }
11754 }
11755#endif
11756
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011757 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11758 "channels, %d 802.11a channels)\n",
11759 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11760 priv->ieee->geo.a_channels);
11761
James Ketrenos43f66a62005-03-25 12:31:53 -060011762 return 0;
11763
James Ketrenosa613bff2005-08-24 21:43:11 -050011764 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011765 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011766 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011767 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011768 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011769 destroy_workqueue(priv->workqueue);
11770 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011771 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011772 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011773 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011774 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011775 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011776 pci_disable_device(pdev);
11777 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011778 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011779 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011780 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011781 return err;
11782}
11783
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011784static void __devexit ipw_pci_remove(struct pci_dev *pdev)
James Ketrenos43f66a62005-03-25 12:31:53 -060011785{
11786 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011787 struct list_head *p, *q;
11788 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011789
James Ketrenos43f66a62005-03-25 12:31:53 -060011790 if (!priv)
11791 return;
11792
Zhu Yi46441512006-01-24 16:37:59 +080011793 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011794
James Ketrenosafbf30a2005-08-25 00:05:33 -050011795 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011796 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011797 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11798
Zhu Yi46441512006-01-24 16:37:59 +080011799 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011800
11801 unregister_netdev(priv->net_dev);
11802
11803 if (priv->rxq) {
11804 ipw_rx_queue_free(priv, priv->rxq);
11805 priv->rxq = NULL;
11806 }
11807 ipw_tx_queue_free(priv);
11808
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011809 if (priv->cmdlog) {
11810 kfree(priv->cmdlog);
11811 priv->cmdlog = NULL;
11812 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011813 /* ipw_down will ensure that there is no more pending work
11814 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011815 cancel_delayed_work(&priv->adhoc_check);
11816 cancel_delayed_work(&priv->gather_stats);
11817 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040011818 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050011819 cancel_delayed_work(&priv->rf_kill);
11820 cancel_delayed_work(&priv->scan_check);
11821 destroy_workqueue(priv->workqueue);
11822 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011823
James Ketrenosafbf30a2005-08-25 00:05:33 -050011824 /* Free MAC hash list for ADHOC */
11825 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11826 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011827 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011828 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011829 }
11830 }
11831
Jesper Juhl8f760782006-06-27 02:55:06 -070011832 kfree(priv->error);
11833 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011834
Zhu Yid685b8c2006-04-13 17:20:27 +080011835#ifdef CONFIG_IPW2200_PROMISCUOUS
11836 ipw_prom_free(priv);
11837#endif
11838
James Ketrenos43f66a62005-03-25 12:31:53 -060011839 free_irq(pdev->irq, priv);
11840 iounmap(priv->hw_base);
11841 pci_release_regions(pdev);
11842 pci_disable_device(pdev);
11843 pci_set_drvdata(pdev, NULL);
11844 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011845 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011846}
11847
James Ketrenos43f66a62005-03-25 12:31:53 -060011848#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011849static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011850{
11851 struct ipw_priv *priv = pci_get_drvdata(pdev);
11852 struct net_device *dev = priv->net_dev;
11853
11854 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11855
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011856 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011857 ipw_down(priv);
11858
11859 /* Remove the PRESENT state of the device */
11860 netif_device_detach(dev);
11861
James Ketrenos43f66a62005-03-25 12:31:53 -060011862 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011863 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011864 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011865
James Ketrenos43f66a62005-03-25 12:31:53 -060011866 return 0;
11867}
11868
11869static int ipw_pci_resume(struct pci_dev *pdev)
11870{
11871 struct ipw_priv *priv = pci_get_drvdata(pdev);
11872 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011873 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011874 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011875
James Ketrenos43f66a62005-03-25 12:31:53 -060011876 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11877
James Ketrenosea2b26e2005-08-24 21:25:16 -050011878 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011879 err = pci_enable_device(pdev);
11880 if (err) {
11881 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11882 dev->name);
11883 return err;
11884 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011885 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011886
James Ketrenos43f66a62005-03-25 12:31:53 -060011887 /*
11888 * Suspend/Resume resets the PCI configuration space, so we have to
11889 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11890 * from interfering with C3 CPU state. pci_restore_state won't help
11891 * here since it only restores the first 64 bytes pci config header.
11892 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011893 pci_read_config_dword(pdev, 0x40, &val);
11894 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011895 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11896
11897 /* Set the device back into the PRESENT state; this will also wake
11898 * the queue of needed */
11899 netif_device_attach(dev);
11900
11901 /* Bring the device back up */
11902 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011903
James Ketrenos43f66a62005-03-25 12:31:53 -060011904 return 0;
11905}
11906#endif
11907
Zhu Yic8c22c92006-08-21 11:38:39 +080011908static void ipw_pci_shutdown(struct pci_dev *pdev)
11909{
11910 struct ipw_priv *priv = pci_get_drvdata(pdev);
11911
11912 /* Take down the device; powers it off, etc. */
11913 ipw_down(priv);
11914
11915 pci_disable_device(pdev);
11916}
11917
James Ketrenos43f66a62005-03-25 12:31:53 -060011918/* driver initialization stuff */
11919static struct pci_driver ipw_driver = {
11920 .name = DRV_NAME,
11921 .id_table = card_ids,
11922 .probe = ipw_pci_probe,
11923 .remove = __devexit_p(ipw_pci_remove),
11924#ifdef CONFIG_PM
11925 .suspend = ipw_pci_suspend,
11926 .resume = ipw_pci_resume,
11927#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011928 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011929};
11930
11931static int __init ipw_init(void)
11932{
11933 int ret;
11934
11935 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11936 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11937
Jeff Garzik29917622006-08-19 17:48:59 -040011938 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011939 if (ret) {
11940 IPW_ERROR("Unable to initialize PCI module\n");
11941 return ret;
11942 }
11943
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011944 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011945 if (ret) {
11946 IPW_ERROR("Unable to create driver sysfs file\n");
11947 pci_unregister_driver(&ipw_driver);
11948 return ret;
11949 }
11950
11951 return ret;
11952}
11953
11954static void __exit ipw_exit(void)
11955{
11956 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11957 pci_unregister_driver(&ipw_driver);
11958}
11959
11960module_param(disable, int, 0444);
11961MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11962
11963module_param(associate, int, 0444);
11964MODULE_PARM_DESC(associate, "auto associate when scanning (default on)");
11965
11966module_param(auto_create, int, 0444);
11967MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11968
James Ketrenosa613bff2005-08-24 21:43:11 -050011969module_param(led, int, 0444);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011970MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011971
James Ketrenos43f66a62005-03-25 12:31:53 -060011972module_param(debug, int, 0444);
11973MODULE_PARM_DESC(debug, "debug output mask");
11974
11975module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011976MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011977
Zhu Yid685b8c2006-04-13 17:20:27 +080011978#ifdef CONFIG_IPW2200_PROMISCUOUS
11979module_param(rtap_iface, int, 0444);
11980MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11981#endif
11982
Zhu Yie43e3c12006-04-13 17:20:45 +080011983#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011984module_param(qos_enable, int, 0444);
11985MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011986
James Ketrenosb095c382005-08-24 22:04:42 -050011987module_param(qos_burst_enable, int, 0444);
11988MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11989
11990module_param(qos_no_ack_mask, int, 0444);
11991MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11992
11993module_param(burst_duration_CCK, int, 0444);
11994MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11995
11996module_param(burst_duration_OFDM, int, 0444);
11997MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011998#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011999
12000#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060012001module_param(mode, int, 0444);
12002MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
12003#else
12004module_param(mode, int, 0444);
12005MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
12006#endif
12007
Zhu Yi810dabd2006-01-24 16:36:59 +080012008module_param(bt_coexist, int, 0444);
12009MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
12010
James Ketrenosb095c382005-08-24 22:04:42 -050012011module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080012012MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050012013
James Ketrenosf6c5cb72005-08-25 00:39:09 -050012014module_param(cmdlog, int, 0444);
12015MODULE_PARM_DESC(cmdlog,
12016 "allocate a ring buffer for logging firmware commands");
12017
Zhu Yi4bfdb912006-01-24 16:37:16 +080012018module_param(roaming, int, 0444);
12019MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
12020
Zhu Yid2b83e12006-04-13 17:19:36 +080012021module_param(antenna, int, 0444);
12022MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
12023
James Ketrenos43f66a62005-03-25 12:31:53 -060012024module_exit(ipw_exit);
12025module_init(ipw_init);