blob: 0b2c774f5ee787b9110773dbad47bffce58ef05c [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 Yi555fd912006-04-13 17:20:40 +080073#define IPW2200_VERSION "1.1.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;
Zhu Yi5dc81c32006-04-13 17:19:44 +080086#ifdef CONFIG_IPW2200_DEBUG
James Ketrenos43f66a62005-03-25 12:31:53 -060087static int debug = 0;
Zhu Yi5dc81c32006-04-13 17:19:44 +080088#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060089static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060090static int mode = 0;
91
92static u32 ipw_debug_level;
93static int associate = 1;
94static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050095static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060096static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080097static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080098static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080099static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -0600100static const char ipw_modes[] = {
101 'a', 'b', 'g', '?'
102};
Zhu Yid2b83e12006-04-13 17:19:36 +0800103static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600104
Zhu Yid685b8c2006-04-13 17:20:27 +0800105#ifdef CONFIG_IPW2200_PROMISCUOUS
106static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
107#endif
108
109
Zhu Yie43e3c12006-04-13 17:20:45 +0800110#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500111static int qos_enable = 0;
112static int qos_burst_enable = 0;
113static int qos_no_ack_mask = 0;
114static int burst_duration_CCK = 0;
115static int burst_duration_OFDM = 0;
116
117static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
118 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
119 QOS_TX3_CW_MIN_OFDM},
120 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
121 QOS_TX3_CW_MAX_OFDM},
122 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
123 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
124 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
125 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
126};
127
128static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
129 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
130 QOS_TX3_CW_MIN_CCK},
131 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
132 QOS_TX3_CW_MAX_CCK},
133 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
134 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
135 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
136 QOS_TX3_TXOP_LIMIT_CCK}
137};
138
139static struct ieee80211_qos_parameters def_parameters_OFDM = {
140 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
141 DEF_TX3_CW_MIN_OFDM},
142 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
143 DEF_TX3_CW_MAX_OFDM},
144 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
145 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
146 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
147 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
148};
149
150static struct ieee80211_qos_parameters def_parameters_CCK = {
151 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
152 DEF_TX3_CW_MIN_CCK},
153 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
154 DEF_TX3_CW_MAX_CCK},
155 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
156 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
157 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
158 DEF_TX3_TXOP_LIMIT_CCK}
159};
160
161static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
162
163static int from_priority_to_tx_queue[] = {
164 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
165 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
166};
167
168static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
169
170static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
171 *qos_param);
172static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
173 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800174#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500175
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000176static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500177static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600178static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400179static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600180 struct clx2_tx_queue *txq, int qindex);
181static int ipw_queue_reset(struct ipw_priv *priv);
182
183static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
184 int len, int sync);
185
186static void ipw_tx_queue_free(struct ipw_priv *);
187
188static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
189static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
190static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600191static int ipw_up(struct ipw_priv *);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500192static void ipw_bg_up(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600193static void ipw_down(struct ipw_priv *);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500194static void ipw_bg_down(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600195static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400196static int init_supported_rates(struct ipw_priv *priv,
197 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500198static void ipw_set_hwcrypto_keys(struct ipw_priv *);
199static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600200
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500201static int snprint_line(char *buf, size_t count,
202 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600203{
204 int out, i, j, l;
205 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400206
James Ketrenos43f66a62005-03-25 12:31:53 -0600207 out = snprintf(buf, count, "%08X", ofs);
208
209 for (l = 0, i = 0; i < 2; i++) {
210 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400211 for (j = 0; j < 8 && l < len; j++, l++)
212 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600213 data[(i * 8 + j)]);
214 for (; j < 8; j++)
215 out += snprintf(buf + out, count - out, " ");
216 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400217
James Ketrenos43f66a62005-03-25 12:31:53 -0600218 out += snprintf(buf + out, count - out, " ");
219 for (l = 0, i = 0; i < 2; i++) {
220 out += snprintf(buf + out, count - out, " ");
221 for (j = 0; j < 8 && l < len; j++, l++) {
222 c = data[(i * 8 + j)];
223 if (!isascii(c) || !isprint(c))
224 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400225
James Ketrenos43f66a62005-03-25 12:31:53 -0600226 out += snprintf(buf + out, count - out, "%c", c);
227 }
228
229 for (; j < 8; j++)
230 out += snprintf(buf + out, count - out, " ");
231 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400232
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500233 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600234}
235
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400236static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600237{
238 char line[81];
239 u32 ofs = 0;
240 if (!(ipw_debug_level & level))
241 return;
242
243 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500244 snprint_line(line, sizeof(line), &data[ofs],
245 min(len, 16U), ofs);
246 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600247 ofs += 16;
248 len -= min(len, 16U);
249 }
250}
251
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500252static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
253{
254 size_t out = size;
255 u32 ofs = 0;
256 int total = 0;
257
258 while (size && len) {
259 out = snprint_line(output, size, &data[ofs],
260 min_t(size_t, len, 16U), ofs);
261
262 ofs += 16;
263 output += out;
264 size -= out;
265 len -= min_t(size_t, len, 16U);
266 total += out;
267 }
268 return total;
269}
270
Zhu Yic8fe6672006-01-24 16:36:36 +0800271/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600272static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
273#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
274
Zhu Yic8fe6672006-01-24 16:36:36 +0800275/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600276static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
277#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
278
Zhu Yic8fe6672006-01-24 16:36:36 +0800279/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600280static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
281static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
282{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400283 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
284 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600285 _ipw_write_reg8(a, b, c);
286}
287
Zhu Yic8fe6672006-01-24 16:36:36 +0800288/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600289static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
290static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
291{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400292 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
293 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600294 _ipw_write_reg16(a, b, c);
295}
296
Zhu Yic8fe6672006-01-24 16:36:36 +0800297/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600298static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
299static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
300{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400301 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
302 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600303 _ipw_write_reg32(a, b, c);
304}
305
Zhu Yic8fe6672006-01-24 16:36:36 +0800306/* 8-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600307#define _ipw_write8(ipw, ofs, val) writeb((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800308
309/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600310#define ipw_write8(ipw, ofs, val) \
311 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
312 _ipw_write8(ipw, ofs, val)
313
Zhu Yic8fe6672006-01-24 16:36:36 +0800314/* 16-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600315#define _ipw_write16(ipw, ofs, val) writew((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800316
317/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600318#define ipw_write16(ipw, ofs, val) \
319 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
320 _ipw_write16(ipw, ofs, val)
321
Zhu Yic8fe6672006-01-24 16:36:36 +0800322/* 32-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600323#define _ipw_write32(ipw, ofs, val) writel((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800324
325/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600326#define ipw_write32(ipw, ofs, val) \
327 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
328 _ipw_write32(ipw, ofs, val)
329
Zhu Yic8fe6672006-01-24 16:36:36 +0800330/* 8-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600331#define _ipw_read8(ipw, ofs) readb((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800332
333/* 8-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400334static inline u8 __ipw_read8(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
335{
336 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600337 return _ipw_read8(ipw, ofs);
338}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400339
Zhu Yic8fe6672006-01-24 16:36:36 +0800340/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600341#define ipw_read8(ipw, ofs) __ipw_read8(__FILE__, __LINE__, ipw, ofs)
342
Zhu Yic8fe6672006-01-24 16:36:36 +0800343/* 16-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600344#define _ipw_read16(ipw, ofs) readw((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800345
346/* 16-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400347static inline u16 __ipw_read16(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
348{
349 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600350 return _ipw_read16(ipw, ofs);
351}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400352
Zhu Yic8fe6672006-01-24 16:36:36 +0800353/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600354#define ipw_read16(ipw, ofs) __ipw_read16(__FILE__, __LINE__, ipw, ofs)
355
Zhu Yic8fe6672006-01-24 16:36:36 +0800356/* 32-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600357#define _ipw_read32(ipw, ofs) readl((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800358
359/* 32-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400360static inline u32 __ipw_read32(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
361{
362 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600363 return _ipw_read32(ipw, ofs);
364}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400365
Zhu Yic8fe6672006-01-24 16:36:36 +0800366/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600367#define ipw_read32(ipw, ofs) __ipw_read32(__FILE__, __LINE__, ipw, ofs)
368
Zhu Yic8fe6672006-01-24 16:36:36 +0800369/* multi-byte read (above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600370static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500371static inline void __ipw_read_indirect(const char *f, int l,
372 struct ipw_priv *a, u32 b, u8 * c, int d)
373{
374 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %d bytes\n", f, l, (u32) (b),
375 d);
376 _ipw_read_indirect(a, b, c, d);
377}
378
Zhu Yic8fe6672006-01-24 16:36:36 +0800379/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500380#define ipw_read_indirect(a, b, c, d) __ipw_read_indirect(__FILE__, __LINE__, a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600381
Zhu Yic8fe6672006-01-24 16:36:36 +0800382/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400383static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
384 int num);
James Ketrenos43f66a62005-03-25 12:31:53 -0600385#define ipw_write_indirect(a, b, c, d) \
386 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %d bytes\n", __FILE__, __LINE__, (u32)(b), d); \
James Ketrenosafbf30a2005-08-25 00:05:33 -0500387 _ipw_write_indirect(a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600388
Zhu Yic8fe6672006-01-24 16:36:36 +0800389/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400390static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600391{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400392 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500393 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
394 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600395}
396
Zhu Yic8fe6672006-01-24 16:36:36 +0800397/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600398static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
399{
Zhu Yi2638bc32006-01-24 16:37:52 +0800400 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800401 u32 dif_len = reg - aligned_addr;
402
James Ketrenos43f66a62005-03-25 12:31:53 -0600403 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800404 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
405 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600406}
407
Zhu Yic8fe6672006-01-24 16:36:36 +0800408/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400409static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600410{
Zhu Yi2638bc32006-01-24 16:37:52 +0800411 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800412 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
413
James Ketrenos43f66a62005-03-25 12:31:53 -0600414 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800415 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
416 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600417}
418
Zhu Yic8fe6672006-01-24 16:36:36 +0800419/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600420static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
421{
422 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500423 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600424 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500425 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400426 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600427}
428
Zhu Yic8fe6672006-01-24 16:36:36 +0800429/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600430static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
431{
432 u32 value;
433
434 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
435
James Ketrenosb095c382005-08-24 22:04:42 -0500436 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
437 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600438 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
439 return value;
440}
441
Zhu Yic8fe6672006-01-24 16:36:36 +0800442/* General purpose, no alignment requirement, iterative (multi-byte) read, */
443/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600444static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
445 int num)
446{
Zhu Yi2638bc32006-01-24 16:37:52 +0800447 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600448 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600449 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400450
James Ketrenos43f66a62005-03-25 12:31:53 -0600451 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
452
James Ketrenosea2b26e2005-08-24 21:25:16 -0500453 if (num <= 0) {
454 return;
455 }
456
Zhu Yic8fe6672006-01-24 16:36:36 +0800457 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600458 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500459 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600460 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500461 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500462 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600463 aligned_addr += 4;
464 }
465
Zhu Yic8fe6672006-01-24 16:36:36 +0800466 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500467 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500468 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500469 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400470
Zhu Yic8fe6672006-01-24 16:36:36 +0800471 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500472 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500473 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500474 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500475 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500476 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600477}
478
Zhu Yic8fe6672006-01-24 16:36:36 +0800479/* General purpose, no alignment requirement, iterative (multi-byte) write, */
480/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400481static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600482 int num)
483{
Zhu Yi2638bc32006-01-24 16:37:52 +0800484 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600485 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600486 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400487
James Ketrenos43f66a62005-03-25 12:31:53 -0600488 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400489
James Ketrenosea2b26e2005-08-24 21:25:16 -0500490 if (num <= 0) {
491 return;
492 }
493
Zhu Yic8fe6672006-01-24 16:36:36 +0800494 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600495 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500496 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800497 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500498 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500499 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600500 aligned_addr += 4;
501 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400502
Zhu Yic8fe6672006-01-24 16:36:36 +0800503 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500504 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500505 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500506 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400507
Zhu Yic8fe6672006-01-24 16:36:36 +0800508 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500509 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500510 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500511 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500512 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500513 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600514}
515
Zhu Yic8fe6672006-01-24 16:36:36 +0800516/* General purpose, no alignment requirement, iterative (multi-byte) write, */
517/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400518static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600519 int num)
520{
521 memcpy_toio((priv->hw_base + addr), buf, num);
522}
523
Zhu Yic8fe6672006-01-24 16:36:36 +0800524/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600525static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
526{
527 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
528}
529
Zhu Yic8fe6672006-01-24 16:36:36 +0800530/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600531static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
532{
533 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
534}
535
Zhu Yi89c318e2006-06-08 22:19:49 -0700536static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600537{
538 if (priv->status & STATUS_INT_ENABLED)
539 return;
540 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500541 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600542}
543
Zhu Yi89c318e2006-06-08 22:19:49 -0700544static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600545{
546 if (!(priv->status & STATUS_INT_ENABLED))
547 return;
548 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500549 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600550}
551
Zhu Yi89c318e2006-06-08 22:19:49 -0700552static inline void ipw_enable_interrupts(struct ipw_priv *priv)
553{
554 unsigned long flags;
555
556 spin_lock_irqsave(&priv->irq_lock, flags);
557 __ipw_enable_interrupts(priv);
558 spin_unlock_irqrestore(&priv->irq_lock, flags);
559}
560
561static inline void ipw_disable_interrupts(struct ipw_priv *priv)
562{
563 unsigned long flags;
564
565 spin_lock_irqsave(&priv->irq_lock, flags);
566 __ipw_disable_interrupts(priv);
567 spin_unlock_irqrestore(&priv->irq_lock, flags);
568}
569
James Ketrenos43f66a62005-03-25 12:31:53 -0600570static char *ipw_error_desc(u32 val)
571{
572 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400573 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600574 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400575 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600576 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400577 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600578 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400579 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600580 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400581 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500582 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400583 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500584 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500586 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500588 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500590 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500592 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400593 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500594 return "DMA_STATUS";
595 case IPW_FW_ERROR_DINO_ERROR:
596 return "DINO_ERROR";
597 case IPW_FW_ERROR_EEPROM_ERROR:
598 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400603 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500604 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600605 }
606}
607
James Ketrenosb39860c2005-08-12 09:36:32 -0500608static void ipw_dump_error_log(struct ipw_priv *priv,
609 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600610{
James Ketrenosb39860c2005-08-12 09:36:32 -0500611 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600612
James Ketrenosb39860c2005-08-12 09:36:32 -0500613 if (!error) {
614 IPW_ERROR("Error allocating and capturing error log. "
615 "Nothing to dump.\n");
616 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600617 }
618
James Ketrenosb39860c2005-08-12 09:36:32 -0500619 IPW_ERROR("Start IPW Error Log Dump:\n");
620 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
621 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600622
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400624 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500625 ipw_error_desc(error->elem[i].desc),
626 error->elem[i].time,
627 error->elem[i].blink1,
628 error->elem[i].blink2,
629 error->elem[i].link1,
630 error->elem[i].link2, error->elem[i].data);
631 for (i = 0; i < error->log_len; i++)
632 IPW_ERROR("%i\t0x%08x\t%i\n",
633 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500634 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600635}
James Ketrenos43f66a62005-03-25 12:31:53 -0600636
James Ketrenosc848d0a2005-08-24 21:56:24 -0500637static inline int ipw_is_init(struct ipw_priv *priv)
638{
639 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600640}
641
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400642static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600643{
644 u32 addr, field_info, field_len, field_count, total_len;
645
646 IPW_DEBUG_ORD("ordinal = %i\n", ord);
647
648 if (!priv || !val || !len) {
649 IPW_DEBUG_ORD("Invalid argument\n");
650 return -EINVAL;
651 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400652
James Ketrenos43f66a62005-03-25 12:31:53 -0600653 /* verify device ordinal tables have been initialized */
654 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
655 IPW_DEBUG_ORD("Access ordinals before initialization\n");
656 return -EINVAL;
657 }
658
659 switch (IPW_ORD_TABLE_ID_MASK & ord) {
660 case IPW_ORD_TABLE_0_MASK:
661 /*
662 * TABLE 0: Direct access to a table of 32 bit values
663 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400664 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600665 * read from the table
666 */
667
668 /* remove the table id from the ordinal */
669 ord &= IPW_ORD_TABLE_VALUE_MASK;
670
671 /* boundary check */
672 if (ord > priv->table0_len) {
673 IPW_DEBUG_ORD("ordinal value (%i) longer then "
674 "max (%i)\n", ord, priv->table0_len);
675 return -EINVAL;
676 }
677
678 /* verify we have enough room to store the value */
679 if (*len < sizeof(u32)) {
680 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200681 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600682 return -EINVAL;
683 }
684
685 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400686 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600687
688 *len = sizeof(u32);
689 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400690 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600691 break;
692
693 case IPW_ORD_TABLE_1_MASK:
694 /*
695 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400696 *
697 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600698 * representing starting addr for the data (which is
699 * also a u32)
700 */
701
702 /* remove the table id from the ordinal */
703 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400704
James Ketrenos43f66a62005-03-25 12:31:53 -0600705 /* boundary check */
706 if (ord > priv->table1_len) {
707 IPW_DEBUG_ORD("ordinal value too long\n");
708 return -EINVAL;
709 }
710
711 /* verify we have enough room to store the value */
712 if (*len < sizeof(u32)) {
713 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200714 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600715 return -EINVAL;
716 }
717
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400718 *((u32 *) val) =
719 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600720 *len = sizeof(u32);
721 break;
722
723 case IPW_ORD_TABLE_2_MASK:
724 /*
725 * TABLE 2: Indirect access to a table of variable sized values
726 *
727 * This table consist of six values, each containing
728 * - dword containing the starting offset of the data
729 * - dword containing the lengh in the first 16bits
730 * and the count in the second 16bits
731 */
732
733 /* remove the table id from the ordinal */
734 ord &= IPW_ORD_TABLE_VALUE_MASK;
735
736 /* boundary check */
737 if (ord > priv->table2_len) {
738 IPW_DEBUG_ORD("ordinal value too long\n");
739 return -EINVAL;
740 }
741
742 /* get the address of statistic */
743 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400744
745 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600746 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400747 field_info =
748 ipw_read_reg32(priv,
749 priv->table2_addr + (ord << 3) +
750 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400751
James Ketrenos43f66a62005-03-25 12:31:53 -0600752 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400753 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400754
James Ketrenos43f66a62005-03-25 12:31:53 -0600755 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400756 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400757
James Ketrenos43f66a62005-03-25 12:31:53 -0600758 /* abort if not enought memory */
759 total_len = field_len * field_count;
760 if (total_len > *len) {
761 *len = total_len;
762 return -EINVAL;
763 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400764
James Ketrenos43f66a62005-03-25 12:31:53 -0600765 *len = total_len;
766 if (!total_len)
767 return 0;
768
769 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400770 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600771 addr, total_len, field_info);
772 ipw_read_indirect(priv, addr, val, total_len);
773 break;
774
775 default:
776 IPW_DEBUG_ORD("Invalid ordinal!\n");
777 return -EINVAL;
778
779 }
780
James Ketrenos43f66a62005-03-25 12:31:53 -0600781 return 0;
782}
783
784static void ipw_init_ordinals(struct ipw_priv *priv)
785{
786 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400787 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600788
789 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
790 priv->table0_addr, priv->table0_len);
791
792 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
793 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
794
795 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
796 priv->table1_addr, priv->table1_len);
797
798 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
799 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400800 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600801
802 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
803 priv->table2_addr, priv->table2_len);
804
805}
806
Adrian Bunka73e22b2006-01-21 01:39:42 +0100807static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500808{
James Ketrenosb095c382005-08-24 22:04:42 -0500809 reg &= ~IPW_START_STANDBY;
810 if (reg & IPW_GATE_ODMA)
811 reg &= ~IPW_GATE_ODMA;
812 if (reg & IPW_GATE_IDMA)
813 reg &= ~IPW_GATE_IDMA;
814 if (reg & IPW_GATE_ADMA)
815 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500816 return reg;
817}
818
819/*
820 * LED behavior:
821 * - On radio ON, turn on any LEDs that require to be on during start
822 * - On initialization, start unassociated blink
823 * - On association, disable unassociated blink
824 * - On disassociation, start unassociated blink
825 * - On radio OFF, turn off any LEDs started during radio on
826 *
827 */
Zhu Yiede61112006-01-24 16:37:10 +0800828#define LD_TIME_LINK_ON msecs_to_jiffies(300)
829#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
830#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500831
Adrian Bunka73e22b2006-01-21 01:39:42 +0100832static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500833{
834 unsigned long flags;
835 u32 led;
836
837 /* If configured to not use LEDs, or nic_type is 1,
838 * then we don't toggle a LINK led */
839 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
840 return;
841
842 spin_lock_irqsave(&priv->lock, flags);
843
844 if (!(priv->status & STATUS_RF_KILL_MASK) &&
845 !(priv->status & STATUS_LED_LINK_ON)) {
846 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500847 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500848 led |= priv->led_association_on;
849
850 led = ipw_register_toggle(led);
851
852 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500853 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500854
855 priv->status |= STATUS_LED_LINK_ON;
856
857 /* If we aren't associated, schedule turning the LED off */
858 if (!(priv->status & STATUS_ASSOCIATED))
859 queue_delayed_work(priv->workqueue,
860 &priv->led_link_off,
861 LD_TIME_LINK_ON);
862 }
863
864 spin_unlock_irqrestore(&priv->lock, flags);
865}
866
James Ketrenosc848d0a2005-08-24 21:56:24 -0500867static void ipw_bg_led_link_on(void *data)
868{
869 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800870 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500871 ipw_led_link_on(data);
Zhu Yi46441512006-01-24 16:37:59 +0800872 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500873}
874
Adrian Bunka73e22b2006-01-21 01:39:42 +0100875static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500876{
877 unsigned long flags;
878 u32 led;
879
880 /* If configured not to use LEDs, or nic type is 1,
881 * then we don't goggle the LINK led. */
882 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
883 return;
884
885 spin_lock_irqsave(&priv->lock, flags);
886
887 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500888 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500889 led &= priv->led_association_off;
890 led = ipw_register_toggle(led);
891
892 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500893 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500894
895 IPW_DEBUG_LED("Link LED Off\n");
896
897 priv->status &= ~STATUS_LED_LINK_ON;
898
899 /* If we aren't associated and the radio is on, schedule
900 * turning the LED on (blink while unassociated) */
901 if (!(priv->status & STATUS_RF_KILL_MASK) &&
902 !(priv->status & STATUS_ASSOCIATED))
903 queue_delayed_work(priv->workqueue, &priv->led_link_on,
904 LD_TIME_LINK_OFF);
905
906 }
907
908 spin_unlock_irqrestore(&priv->lock, flags);
909}
910
James Ketrenosc848d0a2005-08-24 21:56:24 -0500911static void ipw_bg_led_link_off(void *data)
912{
913 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800914 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500915 ipw_led_link_off(data);
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
James Ketrenosc848d0a2005-08-24 21:56:24 -0500990static void ipw_bg_led_activity_off(void *data)
991{
992 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800993 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500994 ipw_led_activity_off(data);
Zhu Yi46441512006-01-24 16:37:59 +0800995 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500996}
997
Adrian Bunka73e22b2006-01-21 01:39:42 +0100998static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500999{
1000 unsigned long flags;
1001 u32 led;
1002
1003 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001004 if (priv->config & CFG_NO_LED ||
1005 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001006 return;
1007
1008 spin_lock_irqsave(&priv->lock, flags);
1009
James Ketrenosb095c382005-08-24 22:04:42 -05001010 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001011 if (priv->assoc_network->mode == IEEE_A) {
1012 led |= priv->led_ofdm_on;
1013 led &= priv->led_association_off;
1014 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1015 } else if (priv->assoc_network->mode == IEEE_G) {
1016 led |= priv->led_ofdm_on;
1017 led |= priv->led_association_on;
1018 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1019 } else {
1020 led &= priv->led_ofdm_off;
1021 led |= priv->led_association_on;
1022 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1023 }
1024
1025 led = ipw_register_toggle(led);
1026
1027 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001028 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001029
1030 spin_unlock_irqrestore(&priv->lock, flags);
1031}
1032
Adrian Bunka73e22b2006-01-21 01:39:42 +01001033static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001034{
1035 unsigned long flags;
1036 u32 led;
1037
1038 /* Only nic type 1 supports mode LEDs */
1039 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1040 return;
1041
1042 spin_lock_irqsave(&priv->lock, flags);
1043
James Ketrenosb095c382005-08-24 22:04:42 -05001044 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001045 led &= priv->led_ofdm_off;
1046 led &= priv->led_association_off;
1047
1048 led = ipw_register_toggle(led);
1049
1050 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001051 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001052
1053 spin_unlock_irqrestore(&priv->lock, flags);
1054}
1055
Adrian Bunka73e22b2006-01-21 01:39:42 +01001056static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001057{
1058 ipw_led_link_on(priv);
1059}
1060
Adrian Bunka73e22b2006-01-21 01:39:42 +01001061static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001062{
1063 ipw_led_activity_off(priv);
1064 ipw_led_link_off(priv);
1065}
1066
Adrian Bunka73e22b2006-01-21 01:39:42 +01001067static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001068{
1069 /* Set the Link Led on for all nic types */
1070 ipw_led_link_on(priv);
1071}
1072
Adrian Bunka73e22b2006-01-21 01:39:42 +01001073static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001074{
1075 ipw_led_activity_off(priv);
1076 ipw_led_link_off(priv);
1077
1078 if (priv->status & STATUS_RF_KILL_MASK)
1079 ipw_led_radio_off(priv);
1080}
1081
Adrian Bunka73e22b2006-01-21 01:39:42 +01001082static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001083{
1084 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1085
1086 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001087 priv->led_activity_on = IPW_ACTIVITY_LED;
1088 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001089
James Ketrenosb095c382005-08-24 22:04:42 -05001090 priv->led_association_on = IPW_ASSOCIATED_LED;
1091 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001092
1093 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001094 priv->led_ofdm_on = IPW_OFDM_LED;
1095 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001096
1097 switch (priv->nic_type) {
1098 case EEPROM_NIC_TYPE_1:
1099 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001100 priv->led_activity_on = IPW_ASSOCIATED_LED;
1101 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1102 priv->led_association_on = IPW_ACTIVITY_LED;
1103 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001104
1105 if (!(priv->config & CFG_NO_LED))
1106 ipw_led_band_on(priv);
1107
1108 /* And we don't blink link LEDs for this nic, so
1109 * just return here */
1110 return;
1111
1112 case EEPROM_NIC_TYPE_3:
1113 case EEPROM_NIC_TYPE_2:
1114 case EEPROM_NIC_TYPE_4:
1115 case EEPROM_NIC_TYPE_0:
1116 break;
1117
1118 default:
1119 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1120 priv->nic_type);
1121 priv->nic_type = EEPROM_NIC_TYPE_0;
1122 break;
1123 }
1124
1125 if (!(priv->config & CFG_NO_LED)) {
1126 if (priv->status & STATUS_ASSOCIATED)
1127 ipw_led_link_on(priv);
1128 else
1129 ipw_led_link_off(priv);
1130 }
1131}
1132
Adrian Bunka73e22b2006-01-21 01:39:42 +01001133static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001134{
James Ketrenosa613bff2005-08-24 21:43:11 -05001135 ipw_led_activity_off(priv);
1136 ipw_led_link_off(priv);
1137 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001138 cancel_delayed_work(&priv->led_link_on);
1139 cancel_delayed_work(&priv->led_link_off);
1140 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001141}
1142
James Ketrenos43f66a62005-03-25 12:31:53 -06001143/*
1144 * The following adds a new attribute to the sysfs representation
1145 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1146 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001147 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001148 * See the level definitions in ipw for details.
1149 */
1150static ssize_t show_debug_level(struct device_driver *d, char *buf)
1151{
1152 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1153}
James Ketrenosa613bff2005-08-24 21:43:11 -05001154
1155static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1156 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001157{
1158 char *p = (char *)buf;
1159 u32 val;
1160
1161 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1162 p++;
1163 if (p[0] == 'x' || p[0] == 'X')
1164 p++;
1165 val = simple_strtoul(p, &p, 16);
1166 } else
1167 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001168 if (p == buf)
1169 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001170 ": %s is not in hex or decimal form.\n", buf);
1171 else
1172 ipw_debug_level = val;
1173
1174 return strnlen(buf, count);
1175}
1176
Jeff Garzikbf794512005-07-31 13:07:26 -04001177static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001178 show_debug_level, store_debug_level);
1179
James Ketrenosb39860c2005-08-12 09:36:32 -05001180static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1181{
Zhu Yic8fe6672006-01-24 16:36:36 +08001182 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001183 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1184}
1185
1186static void ipw_capture_event_log(struct ipw_priv *priv,
1187 u32 log_len, struct ipw_event *log)
1188{
1189 u32 base;
1190
1191 if (log_len) {
1192 base = ipw_read32(priv, IPW_EVENT_LOG);
1193 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1194 (u8 *) log, sizeof(*log) * log_len);
1195 }
1196}
1197
1198static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1199{
1200 struct ipw_fw_error *error;
1201 u32 log_len = ipw_get_event_log_len(priv);
1202 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1203 u32 elem_len = ipw_read_reg32(priv, base);
1204
1205 error = kmalloc(sizeof(*error) +
1206 sizeof(*error->elem) * elem_len +
1207 sizeof(*error->log) * log_len, GFP_ATOMIC);
1208 if (!error) {
1209 IPW_ERROR("Memory allocation for firmware error log "
1210 "failed.\n");
1211 return NULL;
1212 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001213 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001214 error->status = priv->status;
1215 error->config = priv->config;
1216 error->elem_len = elem_len;
1217 error->log_len = log_len;
1218 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001219 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001220
1221 ipw_capture_event_log(priv, log_len, error->log);
1222
1223 if (elem_len)
1224 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1225 sizeof(*error->elem) * elem_len);
1226
1227 return error;
1228}
1229
James Ketrenosb39860c2005-08-12 09:36:32 -05001230static ssize_t show_event_log(struct device *d,
1231 struct device_attribute *attr, char *buf)
1232{
1233 struct ipw_priv *priv = dev_get_drvdata(d);
1234 u32 log_len = ipw_get_event_log_len(priv);
1235 struct ipw_event log[log_len];
1236 u32 len = 0, i;
1237
1238 ipw_capture_event_log(priv, log_len, log);
1239
1240 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1241 for (i = 0; i < log_len; i++)
1242 len += snprintf(buf + len, PAGE_SIZE - len,
1243 "\n%08X%08X%08X",
1244 log[i].time, log[i].event, log[i].data);
1245 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1246 return len;
1247}
1248
1249static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1250
1251static ssize_t show_error(struct device *d,
1252 struct device_attribute *attr, char *buf)
1253{
1254 struct ipw_priv *priv = dev_get_drvdata(d);
1255 u32 len = 0, i;
1256 if (!priv->error)
1257 return 0;
1258 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001259 "%08lX%08X%08X%08X",
1260 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001261 priv->error->status,
1262 priv->error->config, priv->error->elem_len);
1263 for (i = 0; i < priv->error->elem_len; i++)
1264 len += snprintf(buf + len, PAGE_SIZE - len,
1265 "\n%08X%08X%08X%08X%08X%08X%08X",
1266 priv->error->elem[i].time,
1267 priv->error->elem[i].desc,
1268 priv->error->elem[i].blink1,
1269 priv->error->elem[i].blink2,
1270 priv->error->elem[i].link1,
1271 priv->error->elem[i].link2,
1272 priv->error->elem[i].data);
1273
1274 len += snprintf(buf + len, PAGE_SIZE - len,
1275 "\n%08X", priv->error->log_len);
1276 for (i = 0; i < priv->error->log_len; i++)
1277 len += snprintf(buf + len, PAGE_SIZE - len,
1278 "\n%08X%08X%08X",
1279 priv->error->log[i].time,
1280 priv->error->log[i].event,
1281 priv->error->log[i].data);
1282 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1283 return len;
1284}
1285
1286static ssize_t clear_error(struct device *d,
1287 struct device_attribute *attr,
1288 const char *buf, size_t count)
1289{
1290 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001291
1292 kfree(priv->error);
1293 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001294 return count;
1295}
1296
1297static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1298
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001299static ssize_t show_cmd_log(struct device *d,
1300 struct device_attribute *attr, char *buf)
1301{
1302 struct ipw_priv *priv = dev_get_drvdata(d);
1303 u32 len = 0, i;
1304 if (!priv->cmdlog)
1305 return 0;
1306 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1307 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1308 i = (i + 1) % priv->cmdlog_len) {
1309 len +=
1310 snprintf(buf + len, PAGE_SIZE - len,
1311 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1312 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1313 priv->cmdlog[i].cmd.len);
1314 len +=
1315 snprintk_buf(buf + len, PAGE_SIZE - len,
1316 (u8 *) priv->cmdlog[i].cmd.param,
1317 priv->cmdlog[i].cmd.len);
1318 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1319 }
1320 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1321 return len;
1322}
1323
1324static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1325
Zhu Yid685b8c2006-04-13 17:20:27 +08001326#ifdef CONFIG_IPW2200_PROMISCUOUS
1327static void ipw_prom_free(struct ipw_priv *priv);
1328static int ipw_prom_alloc(struct ipw_priv *priv);
1329static ssize_t store_rtap_iface(struct device *d,
1330 struct device_attribute *attr,
1331 const char *buf, size_t count)
1332{
1333 struct ipw_priv *priv = dev_get_drvdata(d);
1334 int rc = 0;
1335
1336 if (count < 1)
1337 return -EINVAL;
1338
1339 switch (buf[0]) {
1340 case '0':
1341 if (!rtap_iface)
1342 return count;
1343
1344 if (netif_running(priv->prom_net_dev)) {
1345 IPW_WARNING("Interface is up. Cannot unregister.\n");
1346 return count;
1347 }
1348
1349 ipw_prom_free(priv);
1350 rtap_iface = 0;
1351 break;
1352
1353 case '1':
1354 if (rtap_iface)
1355 return count;
1356
1357 rc = ipw_prom_alloc(priv);
1358 if (!rc)
1359 rtap_iface = 1;
1360 break;
1361
1362 default:
1363 return -EINVAL;
1364 }
1365
1366 if (rc) {
1367 IPW_ERROR("Failed to register promiscuous network "
1368 "device (error %d).\n", rc);
1369 }
1370
1371 return count;
1372}
1373
1374static ssize_t show_rtap_iface(struct device *d,
1375 struct device_attribute *attr,
1376 char *buf)
1377{
1378 struct ipw_priv *priv = dev_get_drvdata(d);
1379 if (rtap_iface)
1380 return sprintf(buf, "%s", priv->prom_net_dev->name);
1381 else {
1382 buf[0] = '-';
1383 buf[1] = '1';
1384 buf[2] = '\0';
1385 return 3;
1386 }
1387}
1388
1389static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1390 store_rtap_iface);
1391
1392static ssize_t store_rtap_filter(struct device *d,
1393 struct device_attribute *attr,
1394 const char *buf, size_t count)
1395{
1396 struct ipw_priv *priv = dev_get_drvdata(d);
1397
1398 if (!priv->prom_priv) {
1399 IPW_ERROR("Attempting to set filter without "
1400 "rtap_iface enabled.\n");
1401 return -EPERM;
1402 }
1403
1404 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1405
1406 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1407 BIT_ARG16(priv->prom_priv->filter));
1408
1409 return count;
1410}
1411
1412static ssize_t show_rtap_filter(struct device *d,
1413 struct device_attribute *attr,
1414 char *buf)
1415{
1416 struct ipw_priv *priv = dev_get_drvdata(d);
1417 return sprintf(buf, "0x%04X",
1418 priv->prom_priv ? priv->prom_priv->filter : 0);
1419}
1420
1421static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1422 store_rtap_filter);
1423#endif
1424
James Ketrenosa613bff2005-08-24 21:43:11 -05001425static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1426 char *buf)
1427{
1428 struct ipw_priv *priv = dev_get_drvdata(d);
1429 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1430}
1431
1432static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1433 const char *buf, size_t count)
1434{
1435 struct ipw_priv *priv = dev_get_drvdata(d);
1436 struct net_device *dev = priv->net_dev;
1437 char buffer[] = "00000000";
1438 unsigned long len =
1439 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1440 unsigned long val;
1441 char *p = buffer;
1442
1443 IPW_DEBUG_INFO("enter\n");
1444
1445 strncpy(buffer, buf, len);
1446 buffer[len] = 0;
1447
1448 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1449 p++;
1450 if (p[0] == 'x' || p[0] == 'X')
1451 p++;
1452 val = simple_strtoul(p, &p, 16);
1453 } else
1454 val = simple_strtoul(p, &p, 10);
1455 if (p == buffer) {
1456 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1457 } else {
1458 priv->ieee->scan_age = val;
1459 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1460 }
1461
1462 IPW_DEBUG_INFO("exit\n");
1463 return len;
1464}
1465
1466static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1467
1468static ssize_t show_led(struct device *d, struct device_attribute *attr,
1469 char *buf)
1470{
1471 struct ipw_priv *priv = dev_get_drvdata(d);
1472 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1473}
1474
1475static ssize_t store_led(struct device *d, struct device_attribute *attr,
1476 const char *buf, size_t count)
1477{
1478 struct ipw_priv *priv = dev_get_drvdata(d);
1479
1480 IPW_DEBUG_INFO("enter\n");
1481
1482 if (count == 0)
1483 return 0;
1484
1485 if (*buf == 0) {
1486 IPW_DEBUG_LED("Disabling LED control.\n");
1487 priv->config |= CFG_NO_LED;
1488 ipw_led_shutdown(priv);
1489 } else {
1490 IPW_DEBUG_LED("Enabling LED control.\n");
1491 priv->config &= ~CFG_NO_LED;
1492 ipw_led_init(priv);
1493 }
1494
1495 IPW_DEBUG_INFO("exit\n");
1496 return count;
1497}
1498
1499static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1500
Andrew Mortonad3fee52005-06-20 14:30:36 -07001501static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001502 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001503{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001504 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001505 return sprintf(buf, "0x%08x\n", (int)p->status);
1506}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001507
James Ketrenos43f66a62005-03-25 12:31:53 -06001508static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1509
Andrew Mortonad3fee52005-06-20 14:30:36 -07001510static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1511 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001512{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001513 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001514 return sprintf(buf, "0x%08x\n", (int)p->config);
1515}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001516
James Ketrenos43f66a62005-03-25 12:31:53 -06001517static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1518
Andrew Mortonad3fee52005-06-20 14:30:36 -07001519static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001520 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001521{
James Ketrenosa613bff2005-08-24 21:43:11 -05001522 struct ipw_priv *priv = d->driver_data;
1523 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001524}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001525
James Ketrenos43f66a62005-03-25 12:31:53 -06001526static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1527
Andrew Mortonad3fee52005-06-20 14:30:36 -07001528static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001529 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001530{
1531 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001532 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001533
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001534 if (ipw_get_ordinal(p, IPW_ORD_STAT_UCODE_VERSION, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001535 return 0;
1536
1537 return sprintf(buf, "0x%08x\n", tmp);
1538}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001539
1540static DEVICE_ATTR(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001541
Andrew Mortonad3fee52005-06-20 14:30:36 -07001542static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1543 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001544{
1545 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001546 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001547
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001548 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001549 return 0;
1550
1551 return sprintf(buf, "0x%08x\n", tmp);
1552}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001553
1554static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001555
1556/*
1557 * Add a device attribute to view/control the delay between eeprom
1558 * operations.
1559 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001560static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001561 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001562{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001563 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001564 return sprintf(buf, "%i\n", n);
1565}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001566static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001567 struct device_attribute *attr,
1568 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001569{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001570 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001571 sscanf(buf, "%i", &p->eeprom_delay);
1572 return strnlen(buf, count);
1573}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001574
1575static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1576 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001577
Andrew Mortonad3fee52005-06-20 14:30:36 -07001578static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001579 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001580{
1581 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001582 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001583
James Ketrenosb095c382005-08-24 22:04:42 -05001584 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001585 return sprintf(buf, "0x%08x\n", reg);
1586}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001587static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001588 struct device_attribute *attr,
1589 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001590{
1591 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001592 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001593
1594 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001595 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001596 return strnlen(buf, count);
1597}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001598
1599static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1600 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001601
Andrew Mortonad3fee52005-06-20 14:30:36 -07001602static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001603 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001604{
1605 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001606 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001607
1608 reg = ipw_read_reg32(p, 0x301100);
1609 return sprintf(buf, "0x%08x\n", reg);
1610}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001611static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001612 struct device_attribute *attr,
1613 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001614{
1615 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001616 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001617
1618 sscanf(buf, "%x", &reg);
1619 ipw_write_reg32(p, 0x301100, reg);
1620 return strnlen(buf, count);
1621}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001622
1623static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1624 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001625
Andrew Mortonad3fee52005-06-20 14:30:36 -07001626static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001627 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001628{
1629 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001630 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001631
Jeff Garzikbf794512005-07-31 13:07:26 -04001632 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001633 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001634 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001635 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001636
James Ketrenos43f66a62005-03-25 12:31:53 -06001637 return sprintf(buf, "0x%08x\n", reg);
1638}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001639static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001640 struct device_attribute *attr,
1641 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001642{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001643 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001644
1645 sscanf(buf, "%x", &priv->indirect_dword);
1646 priv->status |= STATUS_INDIRECT_DWORD;
1647 return strnlen(buf, count);
1648}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001649
1650static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1651 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001652
Andrew Mortonad3fee52005-06-20 14:30:36 -07001653static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001654 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001655{
1656 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001657 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001658
Jeff Garzikbf794512005-07-31 13:07:26 -04001659 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001660 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001661 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001662 reg = 0;
1663
1664 return sprintf(buf, "0x%02x\n", reg);
1665}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001666static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001667 struct device_attribute *attr,
1668 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001669{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001670 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001671
1672 sscanf(buf, "%x", &priv->indirect_byte);
1673 priv->status |= STATUS_INDIRECT_BYTE;
1674 return strnlen(buf, count);
1675}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001676
1677static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001678 show_indirect_byte, store_indirect_byte);
1679
Andrew Mortonad3fee52005-06-20 14:30:36 -07001680static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001681 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001682{
1683 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001684 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001685
Jeff Garzikbf794512005-07-31 13:07:26 -04001686 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001687 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001688 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001689 reg = 0;
1690
1691 return sprintf(buf, "0x%08x\n", reg);
1692}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001693static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001694 struct device_attribute *attr,
1695 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001696{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001697 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001698
1699 sscanf(buf, "%x", &priv->direct_dword);
1700 priv->status |= STATUS_DIRECT_DWORD;
1701 return strnlen(buf, count);
1702}
James Ketrenos43f66a62005-03-25 12:31:53 -06001703
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001704static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1705 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001706
Arjan van de Ven858119e2006-01-14 13:20:43 -08001707static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001708{
1709 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1710 priv->status |= STATUS_RF_KILL_HW;
1711 else
1712 priv->status &= ~STATUS_RF_KILL_HW;
1713
1714 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1715}
1716
Andrew Mortonad3fee52005-06-20 14:30:36 -07001717static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001718 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001719{
1720 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001721 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001722 2 - HW based RF kill active
1723 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001724 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001725 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001726 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001727 return sprintf(buf, "%i\n", val);
1728}
1729
1730static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1731{
Jeff Garzikbf794512005-07-31 13:07:26 -04001732 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001733 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001734 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001735
1736 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1737 disable_radio ? "OFF" : "ON");
1738
1739 if (disable_radio) {
1740 priv->status |= STATUS_RF_KILL_SW;
1741
James Ketrenosa613bff2005-08-24 21:43:11 -05001742 if (priv->workqueue)
James Ketrenos43f66a62005-03-25 12:31:53 -06001743 cancel_delayed_work(&priv->request_scan);
James Ketrenos43f66a62005-03-25 12:31:53 -06001744 queue_work(priv->workqueue, &priv->down);
1745 } else {
1746 priv->status &= ~STATUS_RF_KILL_SW;
1747 if (rf_kill_active(priv)) {
1748 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1749 "disabled by HW switch\n");
1750 /* Make sure the RF_KILL check timer is running */
1751 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001752 queue_delayed_work(priv->workqueue, &priv->rf_kill,
James Ketrenos43f66a62005-03-25 12:31:53 -06001753 2 * HZ);
Jeff Garzikbf794512005-07-31 13:07:26 -04001754 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001755 queue_work(priv->workqueue, &priv->up);
1756 }
1757
1758 return 1;
1759}
1760
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001761static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1762 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001763{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001764 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001765
James Ketrenos43f66a62005-03-25 12:31:53 -06001766 ipw_radio_kill_sw(priv, buf[0] == '1');
1767
1768 return count;
1769}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001770
1771static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001772
James Ketrenosb095c382005-08-24 22:04:42 -05001773static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1774 char *buf)
1775{
1776 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1777 int pos = 0, len = 0;
1778 if (priv->config & CFG_SPEED_SCAN) {
1779 while (priv->speed_scan[pos] != 0)
1780 len += sprintf(&buf[len], "%d ",
1781 priv->speed_scan[pos++]);
1782 return len + sprintf(&buf[len], "\n");
1783 }
1784
1785 return sprintf(buf, "0\n");
1786}
1787
1788static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1789 const char *buf, size_t count)
1790{
1791 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1792 int channel, pos = 0;
1793 const char *p = buf;
1794
1795 /* list of space separated channels to scan, optionally ending with 0 */
1796 while ((channel = simple_strtol(p, NULL, 0))) {
1797 if (pos == MAX_SPEED_SCAN - 1) {
1798 priv->speed_scan[pos] = 0;
1799 break;
1800 }
1801
Larry Finger1867b112006-02-28 09:48:28 -06001802 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001803 priv->speed_scan[pos++] = channel;
1804 else
1805 IPW_WARNING("Skipping invalid channel request: %d\n",
1806 channel);
1807 p = strchr(p, ' ');
1808 if (!p)
1809 break;
1810 while (*p == ' ' || *p == '\t')
1811 p++;
1812 }
1813
1814 if (pos == 0)
1815 priv->config &= ~CFG_SPEED_SCAN;
1816 else {
1817 priv->speed_scan_pos = 0;
1818 priv->config |= CFG_SPEED_SCAN;
1819 }
1820
1821 return count;
1822}
1823
1824static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1825 store_speed_scan);
1826
1827static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1828 char *buf)
1829{
1830 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1831 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1832}
1833
1834static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1835 const char *buf, size_t count)
1836{
1837 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1838 if (buf[0] == '1')
1839 priv->config |= CFG_NET_STATS;
1840 else
1841 priv->config &= ~CFG_NET_STATS;
1842
1843 return count;
1844}
1845
James Ketrenosafbf30a2005-08-25 00:05:33 -05001846static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1847 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001848
James Ketrenosea2b26e2005-08-24 21:25:16 -05001849static void notify_wx_assoc_event(struct ipw_priv *priv)
1850{
1851 union iwreq_data wrqu;
1852 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1853 if (priv->status & STATUS_ASSOCIATED)
1854 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1855 else
1856 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1857 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1858}
1859
James Ketrenos43f66a62005-03-25 12:31:53 -06001860static void ipw_irq_tasklet(struct ipw_priv *priv)
1861{
1862 u32 inta, inta_mask, handled = 0;
1863 unsigned long flags;
1864 int rc = 0;
1865
Zhu Yi89c318e2006-06-08 22:19:49 -07001866 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001867
James Ketrenosb095c382005-08-24 22:04:42 -05001868 inta = ipw_read32(priv, IPW_INTA_RW);
1869 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1870 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001871
1872 /* Add any cached INTA values that need to be handled */
1873 inta |= priv->isr_inta;
1874
Zhu Yi89c318e2006-06-08 22:19:49 -07001875 spin_unlock_irqrestore(&priv->irq_lock, flags);
1876
1877 spin_lock_irqsave(&priv->lock, flags);
1878
James Ketrenos43f66a62005-03-25 12:31:53 -06001879 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001880 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001881 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001882 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001883 }
1884
James Ketrenosb095c382005-08-24 22:04:42 -05001885 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001886 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001887 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001888 priv->status &= ~STATUS_HCMD_ACTIVE;
1889 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001890 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001891 }
1892
James Ketrenosb095c382005-08-24 22:04:42 -05001893 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001894 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001895 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001896 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001897 }
1898
James Ketrenosb095c382005-08-24 22:04:42 -05001899 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001900 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001901 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001902 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001903 }
1904
James Ketrenosb095c382005-08-24 22:04:42 -05001905 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001906 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001907 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001908 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001909 }
1910
James Ketrenosb095c382005-08-24 22:04:42 -05001911 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001912 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001913 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001914 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001915 }
1916
James Ketrenosb095c382005-08-24 22:04:42 -05001917 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001918 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001919 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001920 }
1921
James Ketrenosb095c382005-08-24 22:04:42 -05001922 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001923 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001924 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06001925 }
1926
James Ketrenosb095c382005-08-24 22:04:42 -05001927 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001928 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001929 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001930 }
1931
James Ketrenosb095c382005-08-24 22:04:42 -05001932 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001933 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001934 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001935 }
1936
James Ketrenosb095c382005-08-24 22:04:42 -05001937 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001938 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001939 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001940 }
1941
James Ketrenosb095c382005-08-24 22:04:42 -05001942 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001943 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
1944 priv->status |= STATUS_RF_KILL_HW;
1945 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05001946 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06001947 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05001948 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06001949 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05001950 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001951 }
Jeff Garzikbf794512005-07-31 13:07:26 -04001952
James Ketrenosb095c382005-08-24 22:04:42 -05001953 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001954 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001955 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001956 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001957 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
1958 struct ipw_fw_error *error =
1959 ipw_alloc_error_log(priv);
1960 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07001961 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05001962 }
James Ketrenosb39860c2005-08-12 09:36:32 -05001963 } else {
1964 priv->error = ipw_alloc_error_log(priv);
1965 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001966 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001967 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001968 IPW_DEBUG_FW("Error allocating sysfs 'error' "
1969 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001970 if (ipw_debug_level & IPW_DL_FW_ERRORS)
1971 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05001972 }
1973
James Ketrenosb095c382005-08-24 22:04:42 -05001974 /* XXX: If hardware encryption is for WPA/WPA2,
1975 * we have to notify the supplicant. */
1976 if (priv->ieee->sec.encrypt) {
1977 priv->status &= ~STATUS_ASSOCIATED;
1978 notify_wx_assoc_event(priv);
1979 }
1980
1981 /* Keep the restart process from trying to send host
1982 * commands by clearing the INIT status bit */
1983 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001984
1985 /* Cancel currently queued command. */
1986 priv->status &= ~STATUS_HCMD_ACTIVE;
1987 wake_up_interruptible(&priv->wait_command_queue);
1988
James Ketrenos43f66a62005-03-25 12:31:53 -06001989 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05001990 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06001991 }
1992
James Ketrenosb095c382005-08-24 22:04:42 -05001993 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001994 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001995 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06001996 }
1997
1998 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001999 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002000 }
2001
Zhu Yi89c318e2006-06-08 22:19:49 -07002002 spin_unlock_irqrestore(&priv->lock, flags);
2003
James Ketrenos43f66a62005-03-25 12:31:53 -06002004 /* enable all interrupts */
2005 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002006}
Jeff Garzikbf794512005-07-31 13:07:26 -04002007
James Ketrenos43f66a62005-03-25 12:31:53 -06002008#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2009static char *get_cmd_string(u8 cmd)
2010{
2011 switch (cmd) {
2012 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002013 IPW_CMD(POWER_DOWN);
2014 IPW_CMD(SYSTEM_CONFIG);
2015 IPW_CMD(MULTICAST_ADDRESS);
2016 IPW_CMD(SSID);
2017 IPW_CMD(ADAPTER_ADDRESS);
2018 IPW_CMD(PORT_TYPE);
2019 IPW_CMD(RTS_THRESHOLD);
2020 IPW_CMD(FRAG_THRESHOLD);
2021 IPW_CMD(POWER_MODE);
2022 IPW_CMD(WEP_KEY);
2023 IPW_CMD(TGI_TX_KEY);
2024 IPW_CMD(SCAN_REQUEST);
2025 IPW_CMD(SCAN_REQUEST_EXT);
2026 IPW_CMD(ASSOCIATE);
2027 IPW_CMD(SUPPORTED_RATES);
2028 IPW_CMD(SCAN_ABORT);
2029 IPW_CMD(TX_FLUSH);
2030 IPW_CMD(QOS_PARAMETERS);
2031 IPW_CMD(DINO_CONFIG);
2032 IPW_CMD(RSN_CAPABILITIES);
2033 IPW_CMD(RX_KEY);
2034 IPW_CMD(CARD_DISABLE);
2035 IPW_CMD(SEED_NUMBER);
2036 IPW_CMD(TX_POWER);
2037 IPW_CMD(COUNTRY_INFO);
2038 IPW_CMD(AIRONET_INFO);
2039 IPW_CMD(AP_TX_POWER);
2040 IPW_CMD(CCKM_INFO);
2041 IPW_CMD(CCX_VER_INFO);
2042 IPW_CMD(SET_CALIBRATION);
2043 IPW_CMD(SENSITIVITY_CALIB);
2044 IPW_CMD(RETRY_LIMIT);
2045 IPW_CMD(IPW_PRE_POWER_DOWN);
2046 IPW_CMD(VAP_BEACON_TEMPLATE);
2047 IPW_CMD(VAP_DTIM_PERIOD);
2048 IPW_CMD(EXT_SUPPORTED_RATES);
2049 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2050 IPW_CMD(VAP_QUIET_INTERVALS);
2051 IPW_CMD(VAP_CHANNEL_SWITCH);
2052 IPW_CMD(VAP_MANDATORY_CHANNELS);
2053 IPW_CMD(VAP_CELL_PWR_LIMIT);
2054 IPW_CMD(VAP_CF_PARAM_SET);
2055 IPW_CMD(VAP_SET_BEACONING_STATE);
2056 IPW_CMD(MEASUREMENT);
2057 IPW_CMD(POWER_CAPABILITY);
2058 IPW_CMD(SUPPORTED_CHANNELS);
2059 IPW_CMD(TPC_REPORT);
2060 IPW_CMD(WME_INFO);
2061 IPW_CMD(PRODUCTION_COMMAND);
2062 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002063 return "UNKNOWN";
2064 }
2065}
James Ketrenos43f66a62005-03-25 12:31:53 -06002066
2067#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002068
2069static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002070{
2071 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002072 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002073
James Ketrenosa613bff2005-08-24 21:43:11 -05002074 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002075 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002076 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2077 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002078 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002079 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002080 }
2081
2082 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002083
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002084 if (priv->cmdlog) {
2085 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2086 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2087 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2088 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2089 cmd->len);
2090 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2091 }
2092
James Ketrenosb095c382005-08-24 22:04:42 -05002093 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2094 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2095 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002096
2097#ifndef DEBUG_CMD_WEP_KEY
2098 if (cmd->cmd == IPW_CMD_WEP_KEY)
2099 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2100 else
2101#endif
2102 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2103
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002104 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002105 if (rc) {
2106 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002107 IPW_ERROR("Failed to send %s: Reason %d\n",
2108 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002109 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002110 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002111 }
2112 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002113
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002114 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2115 !(priv->
2116 status & STATUS_HCMD_ACTIVE),
2117 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002118 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002119 spin_lock_irqsave(&priv->lock, flags);
2120 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002121 IPW_ERROR("Failed to send %s: Command timed out.\n",
2122 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002123 priv->status &= ~STATUS_HCMD_ACTIVE;
2124 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002125 rc = -EIO;
2126 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002127 }
2128 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002129 } else
2130 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002131
James Ketrenosb095c382005-08-24 22:04:42 -05002132 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002133 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2134 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002135 rc = -EIO;
2136 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002137 }
2138
Zhu Yi2638bc32006-01-24 16:37:52 +08002139 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002140 if (priv->cmdlog) {
2141 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2142 priv->cmdlog_pos %= priv->cmdlog_len;
2143 }
2144 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002145}
2146
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002147static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002148{
2149 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002150 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002151 };
2152
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002153 return __ipw_send_cmd(priv, &cmd);
2154}
2155
2156static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2157 void *data)
2158{
2159 struct host_cmd cmd = {
2160 .cmd = command,
2161 .len = len,
2162 .param = data,
2163 };
2164
2165 return __ipw_send_cmd(priv, &cmd);
2166}
2167
2168static int ipw_send_host_complete(struct ipw_priv *priv)
2169{
James Ketrenos43f66a62005-03-25 12:31:53 -06002170 if (!priv) {
2171 IPW_ERROR("Invalid args\n");
2172 return -1;
2173 }
2174
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002175 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002176}
2177
Zhu Yid685b8c2006-04-13 17:20:27 +08002178static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002179{
Zhu Yid685b8c2006-04-13 17:20:27 +08002180 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2181 sizeof(priv->sys_config),
2182 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002183}
2184
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002185static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002186{
James Ketrenos43f66a62005-03-25 12:31:53 -06002187 if (!priv || !ssid) {
2188 IPW_ERROR("Invalid args\n");
2189 return -1;
2190 }
2191
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002192 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002193 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002194}
2195
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002196static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002197{
James Ketrenos43f66a62005-03-25 12:31:53 -06002198 if (!priv || !mac) {
2199 IPW_ERROR("Invalid args\n");
2200 return -1;
2201 }
2202
2203 IPW_DEBUG_INFO("%s: Setting MAC to " MAC_FMT "\n",
2204 priv->net_dev->name, MAC_ARG(mac));
2205
Zhu Yi2638bc32006-01-24 16:37:52 +08002206 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002207}
2208
James Ketrenosa613bff2005-08-24 21:43:11 -05002209/*
2210 * NOTE: This must be executed from our workqueue as it results in udelay
2211 * being called which may corrupt the keyboard if executed on default
2212 * workqueue
2213 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002214static void ipw_adapter_restart(void *adapter)
2215{
2216 struct ipw_priv *priv = adapter;
2217
2218 if (priv->status & STATUS_RF_KILL_MASK)
2219 return;
2220
2221 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002222
2223 if (priv->assoc_network &&
2224 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2225 ipw_remove_current_network(priv);
2226
James Ketrenos43f66a62005-03-25 12:31:53 -06002227 if (ipw_up(priv)) {
2228 IPW_ERROR("Failed to up device\n");
2229 return;
2230 }
2231}
2232
James Ketrenosc848d0a2005-08-24 21:56:24 -05002233static void ipw_bg_adapter_restart(void *data)
2234{
2235 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08002236 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002237 ipw_adapter_restart(data);
Zhu Yi46441512006-01-24 16:37:59 +08002238 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002239}
2240
James Ketrenos43f66a62005-03-25 12:31:53 -06002241#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2242
2243static void ipw_scan_check(void *data)
2244{
2245 struct ipw_priv *priv = data;
2246 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2247 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002248 "adapter after (%dms).\n",
2249 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002250 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002251 }
2252}
2253
James Ketrenosc848d0a2005-08-24 21:56:24 -05002254static void ipw_bg_scan_check(void *data)
2255{
2256 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08002257 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002258 ipw_scan_check(data);
Zhu Yi46441512006-01-24 16:37:59 +08002259 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002260}
2261
James Ketrenos43f66a62005-03-25 12:31:53 -06002262static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2263 struct ipw_scan_request_ext *request)
2264{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002265 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002266 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002267}
2268
2269static int ipw_send_scan_abort(struct ipw_priv *priv)
2270{
James Ketrenos43f66a62005-03-25 12:31:53 -06002271 if (!priv) {
2272 IPW_ERROR("Invalid args\n");
2273 return -1;
2274 }
2275
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002276 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002277}
2278
2279static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2280{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002281 struct ipw_sensitivity_calib calib = {
2282 .beacon_rssi_raw = sens,
James Ketrenos43f66a62005-03-25 12:31:53 -06002283 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002284
2285 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002286 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002287}
2288
2289static int ipw_send_associate(struct ipw_priv *priv,
2290 struct ipw_associate *associate)
2291{
James Ketrenosa613bff2005-08-24 21:43:11 -05002292 struct ipw_associate tmp_associate;
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002293
2294 if (!priv || !associate) {
2295 IPW_ERROR("Invalid args\n");
2296 return -1;
2297 }
2298
James Ketrenosa613bff2005-08-24 21:43:11 -05002299 memcpy(&tmp_associate, associate, sizeof(*associate));
2300 tmp_associate.policy_support =
2301 cpu_to_le16(tmp_associate.policy_support);
2302 tmp_associate.assoc_tsf_msw = cpu_to_le32(tmp_associate.assoc_tsf_msw);
2303 tmp_associate.assoc_tsf_lsw = cpu_to_le32(tmp_associate.assoc_tsf_lsw);
2304 tmp_associate.capability = cpu_to_le16(tmp_associate.capability);
2305 tmp_associate.listen_interval =
2306 cpu_to_le16(tmp_associate.listen_interval);
2307 tmp_associate.beacon_interval =
2308 cpu_to_le16(tmp_associate.beacon_interval);
2309 tmp_associate.atim_window = cpu_to_le16(tmp_associate.atim_window);
2310
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002311 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(tmp_associate),
Zhu Yi2638bc32006-01-24 16:37:52 +08002312 &tmp_associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002313}
2314
2315static int ipw_send_supported_rates(struct ipw_priv *priv,
2316 struct ipw_supported_rates *rates)
2317{
James Ketrenos43f66a62005-03-25 12:31:53 -06002318 if (!priv || !rates) {
2319 IPW_ERROR("Invalid args\n");
2320 return -1;
2321 }
2322
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002323 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002324 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002325}
2326
2327static int ipw_set_random_seed(struct ipw_priv *priv)
2328{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002329 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002330
2331 if (!priv) {
2332 IPW_ERROR("Invalid args\n");
2333 return -1;
2334 }
2335
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002336 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002337
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002338 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002339}
2340
James Ketrenos43f66a62005-03-25 12:31:53 -06002341static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2342{
James Ketrenos43f66a62005-03-25 12:31:53 -06002343 if (!priv) {
2344 IPW_ERROR("Invalid args\n");
2345 return -1;
2346 }
2347
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002348 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(phy_off),
Zhu Yi2638bc32006-01-24 16:37:52 +08002349 &phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002350}
James Ketrenos43f66a62005-03-25 12:31:53 -06002351
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002352static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002353{
James Ketrenos43f66a62005-03-25 12:31:53 -06002354 if (!priv || !power) {
2355 IPW_ERROR("Invalid args\n");
2356 return -1;
2357 }
2358
Zhu Yi2638bc32006-01-24 16:37:52 +08002359 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002360}
James Ketrenos43f66a62005-03-25 12:31:53 -06002361
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002362static int ipw_set_tx_power(struct ipw_priv *priv)
2363{
Larry Finger1867b112006-02-28 09:48:28 -06002364 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002365 struct ipw_tx_power tx_power;
2366 s8 max_power;
2367 int i;
2368
2369 memset(&tx_power, 0, sizeof(tx_power));
2370
2371 /* configure device for 'G' band */
2372 tx_power.ieee_mode = IPW_G_MODE;
2373 tx_power.num_channels = geo->bg_channels;
2374 for (i = 0; i < geo->bg_channels; i++) {
2375 max_power = geo->bg[i].max_power;
2376 tx_power.channels_tx_power[i].channel_number =
2377 geo->bg[i].channel;
2378 tx_power.channels_tx_power[i].tx_power = max_power ?
2379 min(max_power, priv->tx_power) : priv->tx_power;
2380 }
2381 if (ipw_send_tx_power(priv, &tx_power))
2382 return -EIO;
2383
2384 /* configure device to also handle 'B' band */
2385 tx_power.ieee_mode = IPW_B_MODE;
2386 if (ipw_send_tx_power(priv, &tx_power))
2387 return -EIO;
2388
2389 /* configure device to also handle 'A' band */
2390 if (priv->ieee->abg_true) {
2391 tx_power.ieee_mode = IPW_A_MODE;
2392 tx_power.num_channels = geo->a_channels;
2393 for (i = 0; i < tx_power.num_channels; i++) {
2394 max_power = geo->a[i].max_power;
2395 tx_power.channels_tx_power[i].channel_number =
2396 geo->a[i].channel;
2397 tx_power.channels_tx_power[i].tx_power = max_power ?
2398 min(max_power, priv->tx_power) : priv->tx_power;
2399 }
2400 if (ipw_send_tx_power(priv, &tx_power))
2401 return -EIO;
2402 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002403 return 0;
2404}
2405
2406static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2407{
2408 struct ipw_rts_threshold rts_threshold = {
2409 .rts_threshold = rts,
2410 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002411
2412 if (!priv) {
2413 IPW_ERROR("Invalid args\n");
2414 return -1;
2415 }
2416
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002417 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2418 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002419}
2420
2421static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2422{
2423 struct ipw_frag_threshold frag_threshold = {
2424 .frag_threshold = frag,
2425 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002426
2427 if (!priv) {
2428 IPW_ERROR("Invalid args\n");
2429 return -1;
2430 }
2431
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002432 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2433 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002434}
2435
2436static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2437{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002438 u32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002439
2440 if (!priv) {
2441 IPW_ERROR("Invalid args\n");
2442 return -1;
2443 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002444
James Ketrenos43f66a62005-03-25 12:31:53 -06002445 /* If on battery, set to 3, if AC set to CAM, else user
2446 * level */
2447 switch (mode) {
2448 case IPW_POWER_BATTERY:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002449 param = IPW_POWER_INDEX_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06002450 break;
2451 case IPW_POWER_AC:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002452 param = IPW_POWER_MODE_CAM;
James Ketrenos43f66a62005-03-25 12:31:53 -06002453 break;
2454 default:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002455 param = mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06002456 break;
2457 }
2458
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002459 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002460 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002461}
2462
James Ketrenosafbf30a2005-08-25 00:05:33 -05002463static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2464{
2465 struct ipw_retry_limit retry_limit = {
2466 .short_retry_limit = slimit,
2467 .long_retry_limit = llimit
2468 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002469
2470 if (!priv) {
2471 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002472 return -1;
2473 }
2474
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002475 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002476 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002477}
2478
2479/*
2480 * The IPW device contains a Microwire compatible EEPROM that stores
2481 * various data like the MAC address. Usually the firmware has exclusive
2482 * access to the eeprom, but during device initialization (before the
2483 * device driver has sent the HostComplete command to the firmware) the
2484 * device driver has read access to the EEPROM by way of indirect addressing
2485 * through a couple of memory mapped registers.
2486 *
2487 * The following is a simplified implementation for pulling data out of the
2488 * the eeprom, along with some helper functions to find information in
2489 * the per device private data's copy of the eeprom.
2490 *
2491 * NOTE: To better understand how these functions work (i.e what is a chip
2492 * select and why do have to keep driving the eeprom clock?), read
2493 * just about any data sheet for a Microwire compatible EEPROM.
2494 */
2495
2496/* write a 32 bit value into the indirect accessor register */
2497static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2498{
2499 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002500
James Ketrenos43f66a62005-03-25 12:31:53 -06002501 /* the eeprom requires some time to complete the operation */
2502 udelay(p->eeprom_delay);
2503
2504 return;
2505}
2506
2507/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002508static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002509{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002510 eeprom_write_reg(priv, 0);
2511 eeprom_write_reg(priv, EEPROM_BIT_CS);
2512 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2513 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002514}
2515
2516/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002517static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002518{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002519 eeprom_write_reg(priv, EEPROM_BIT_CS);
2520 eeprom_write_reg(priv, 0);
2521 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002522}
2523
2524/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002525static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002526{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002527 int d = (bit ? EEPROM_BIT_DI : 0);
2528 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2529 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002530}
2531
2532/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002533static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002534{
2535 int i;
2536
2537 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002538 eeprom_write_bit(priv, 1);
2539 eeprom_write_bit(priv, op & 2);
2540 eeprom_write_bit(priv, op & 1);
2541 for (i = 7; i >= 0; i--) {
2542 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002543 }
2544}
2545
2546/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002547static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002548{
2549 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002550 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002551
James Ketrenos43f66a62005-03-25 12:31:53 -06002552 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002553 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002554
2555 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002556 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002557
2558 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002559 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002560 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002561 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2562 eeprom_write_reg(priv, EEPROM_BIT_CS);
2563 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2564 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002565 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002566
James Ketrenos43f66a62005-03-25 12:31:53 -06002567 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002568 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002569 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002570
James Ketrenos43f66a62005-03-25 12:31:53 -06002571 return r;
2572}
2573
2574/* helper function for pulling the mac address out of the private */
2575/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002576static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002577{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002578 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002579}
2580
2581/*
2582 * Either the device driver (i.e. the host) or the firmware can
2583 * load eeprom data into the designated region in SRAM. If neither
2584 * happens then the FW will shutdown with a fatal error.
2585 *
2586 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2587 * bit needs region of shared SRAM needs to be non-zero.
2588 */
2589static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2590{
2591 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002592 u16 *eeprom = (u16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002593
James Ketrenos43f66a62005-03-25 12:31:53 -06002594 IPW_DEBUG_TRACE(">>\n");
2595
2596 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002597 for (i = 0; i < 128; i++)
James Ketrenosa613bff2005-08-24 21:43:11 -05002598 eeprom[i] = le16_to_cpu(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002599
Jeff Garzikbf794512005-07-31 13:07:26 -04002600 /*
2601 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002602 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002603 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002604 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002605 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002606 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2607
2608 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002609 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002610 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002611
2612 /* Do not load eeprom data on fatal error or suspend */
2613 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2614 } else {
2615 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2616
2617 /* Load eeprom data on fatal error or suspend */
2618 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2619 }
2620
2621 IPW_DEBUG_TRACE("<<\n");
2622}
2623
Arjan van de Ven858119e2006-01-14 13:20:43 -08002624static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002625{
2626 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002627 if (!count)
2628 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002629 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002630 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002631 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002632}
2633
2634static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2635{
James Ketrenosb095c382005-08-24 22:04:42 -05002636 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002637 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002638 sizeof(struct command_block));
2639}
2640
2641static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002642{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002643
2644 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002645
James Ketrenos43f66a62005-03-25 12:31:53 -06002646 /* Start the dma */
2647 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002648
James Ketrenos43f66a62005-03-25 12:31:53 -06002649 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002650 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002651
2652 IPW_DEBUG_FW("<< : \n");
2653 return 0;
2654}
2655
2656static void ipw_fw_dma_abort(struct ipw_priv *priv)
2657{
2658 u32 control = 0;
2659
2660 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002661
Pavel Machek67fd6b42006-07-11 15:34:05 +02002662 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002663 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002664 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002665 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002666
James Ketrenos43f66a62005-03-25 12:31:53 -06002667 IPW_DEBUG_FW("<< \n");
2668}
2669
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002670static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2671 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002672{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002673 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002674 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002675 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002676 IPW_DEBUG_FW(">> :\n");
2677
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002678 ipw_write_indirect(priv, address, (u8 *) cb,
2679 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002680
2681 IPW_DEBUG_FW("<< :\n");
2682 return 0;
2683
2684}
2685
2686static int ipw_fw_dma_kick(struct ipw_priv *priv)
2687{
2688 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002689 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002690
2691 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002692
James Ketrenos43f66a62005-03-25 12:31:53 -06002693 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002694 ipw_fw_dma_write_command_block(priv, index,
2695 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002696
2697 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002698 ipw_clear_bit(priv, IPW_RESET_REG,
2699 IPW_RESET_REG_MASTER_DISABLED |
2700 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002701
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002702 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002703 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002704 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002705
2706 IPW_DEBUG_FW("<< :\n");
2707 return 0;
2708}
2709
2710static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2711{
2712 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002713 u32 register_value = 0;
2714 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002715
2716 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002717 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002718 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002719
2720 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002721 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2722 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002723
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002724 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002725 cb_fields_address = address;
2726 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002727 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002728
2729 cb_fields_address += sizeof(u32);
2730 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002731 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002732
2733 cb_fields_address += sizeof(u32);
2734 register_value = ipw_read_reg32(priv, cb_fields_address);
2735 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2736 register_value);
2737
2738 cb_fields_address += sizeof(u32);
2739 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002740 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002741
2742 IPW_DEBUG_FW(">> :\n");
2743}
2744
2745static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2746{
2747 u32 current_cb_address = 0;
2748 u32 current_cb_index = 0;
2749
2750 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002751 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002752
James Ketrenosb095c382005-08-24 22:04:42 -05002753 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002754 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002755
James Ketrenos43f66a62005-03-25 12:31:53 -06002756 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002757 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002758
2759 IPW_DEBUG_FW(">> :\n");
2760 return current_cb_index;
2761
2762}
2763
2764static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2765 u32 src_address,
2766 u32 dest_address,
2767 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002768 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002769{
2770
Jeff Garzikbf794512005-07-31 13:07:26 -04002771 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002772 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2773 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002774 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002775 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002776
2777 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2778 src_address, dest_address, length);
2779
2780 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2781 return -1;
2782
2783 last_cb_element = priv->sram_desc.last_cb_index;
2784 cb = &priv->sram_desc.cb_list[last_cb_element];
2785 priv->sram_desc.last_cb_index++;
2786
2787 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002788 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002789 control |= CB_INT_ENABLED;
2790
2791 if (is_last)
2792 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002793
James Ketrenos43f66a62005-03-25 12:31:53 -06002794 control |= length;
2795
2796 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002797 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002798
2799 /* Copy the Source and Destination addresses */
2800 cb->dest_addr = dest_address;
2801 cb->source_addr = src_address;
2802
2803 /* Copy the Control Word last */
2804 cb->control = control;
2805
2806 return 0;
2807}
2808
2809static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002810 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002811{
2812 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002813 u32 src_offset = 0;
2814 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002815 int status = 0;
2816 IPW_DEBUG_FW(">> \n");
2817 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2818 src_phys, dest_address, length);
2819 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002820 status = ipw_fw_dma_add_command_block(priv,
2821 src_phys + src_offset,
2822 dest_address +
2823 dest_offset,
2824 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002825 if (status) {
2826 IPW_DEBUG_FW_INFO(": Failed\n");
2827 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002828 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002829 IPW_DEBUG_FW_INFO(": Added new cb\n");
2830
2831 src_offset += CB_MAX_LENGTH;
2832 dest_offset += CB_MAX_LENGTH;
2833 bytes_left -= CB_MAX_LENGTH;
2834 }
2835
2836 /* add the buffer tail */
2837 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002838 status =
2839 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2840 dest_address + dest_offset,
2841 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002842 if (status) {
2843 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2844 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002845 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002846 IPW_DEBUG_FW_INFO
2847 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002848 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002849
James Ketrenos43f66a62005-03-25 12:31:53 -06002850 IPW_DEBUG_FW("<< \n");
2851 return 0;
2852}
2853
2854static int ipw_fw_dma_wait(struct ipw_priv *priv)
2855{
Zhu Yi397ae122006-01-24 16:37:22 +08002856 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002857 u32 watchdog = 0;
2858
2859 IPW_DEBUG_FW(">> : \n");
2860
2861 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002862 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002863 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002864
2865 while (current_index < priv->sram_desc.last_cb_index) {
2866 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002867 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002868 current_index = ipw_fw_dma_command_block_index(priv);
2869
Zhu Yi397ae122006-01-24 16:37:22 +08002870 if (previous_index < current_index) {
2871 watchdog = 0;
2872 continue;
2873 }
2874 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002875 IPW_DEBUG_FW_INFO("Timeout\n");
2876 ipw_fw_dma_dump_command_block(priv);
2877 ipw_fw_dma_abort(priv);
2878 return -1;
2879 }
2880 }
2881
2882 ipw_fw_dma_abort(priv);
2883
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002884 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002885 ipw_set_bit(priv, IPW_RESET_REG,
2886 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002887
2888 IPW_DEBUG_FW("<< dmaWaitSync \n");
2889 return 0;
2890}
2891
Jeff Garzikbf794512005-07-31 13:07:26 -04002892static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002893{
2894 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002895 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002896 unsigned long flags;
2897
2898 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002899 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2900 network = list_entry(element, struct ieee80211_network, list);
2901 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2902 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002903 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002904 &priv->ieee->network_free_list);
2905 }
2906 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002907 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002908}
2909
2910/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002911 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002912 * Reads debug register from domain0.
2913 * If card is present, pre-defined value should
2914 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002915 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002916 * @param priv
2917 * @return 1 if card is present, 0 otherwise
2918 */
2919static inline int ipw_alive(struct ipw_priv *priv)
2920{
2921 return ipw_read32(priv, 0x90) == 0xd55555d5;
2922}
2923
Zhu Yic7b6a672006-01-24 16:37:05 +08002924/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002925static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002926 int timeout)
2927{
2928 int i = 0;
2929
2930 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002931 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002932 return i;
2933 mdelay(10);
2934 i += 10;
2935 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04002936
James Ketrenos43f66a62005-03-25 12:31:53 -06002937 return -ETIME;
2938}
2939
Jeff Garzikbf794512005-07-31 13:07:26 -04002940/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06002941 * the ipw hardware. It assumes the buffer has all the bits for the
2942 * image and the caller is handling the memory allocation and clean up.
2943 */
2944
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002945static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002946{
2947 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002948
James Ketrenos43f66a62005-03-25 12:31:53 -06002949 IPW_DEBUG_TRACE(">> \n");
2950 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05002951 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002952
Zhu Yic7b6a672006-01-24 16:37:05 +08002953 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05002954 rc = ipw_poll_bit(priv, IPW_RESET_REG,
2955 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06002956 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08002957 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002958 return -1;
2959 }
2960
2961 IPW_DEBUG_INFO("stop master %dms\n", rc);
2962
2963 return rc;
2964}
2965
2966static void ipw_arc_release(struct ipw_priv *priv)
2967{
2968 IPW_DEBUG_TRACE(">> \n");
2969 mdelay(5);
2970
James Ketrenosb095c382005-08-24 22:04:42 -05002971 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06002972
2973 /* no one knows timing, for safety add some delay */
2974 mdelay(5);
2975}
2976
James Ketrenos43f66a62005-03-25 12:31:53 -06002977struct fw_chunk {
2978 u32 address;
2979 u32 length;
2980};
2981
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002982static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002983{
2984 int rc = 0, i, addr;
2985 u8 cr = 0;
2986 u16 *image;
2987
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002988 image = (u16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04002989
James Ketrenos43f66a62005-03-25 12:31:53 -06002990 IPW_DEBUG_TRACE(">> \n");
2991
2992 rc = ipw_stop_master(priv);
2993
2994 if (rc < 0)
2995 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002996
James Ketrenosb095c382005-08-24 22:04:42 -05002997 for (addr = IPW_SHARED_LOWER_BOUND;
2998 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002999 ipw_write32(priv, addr, 0);
3000 }
3001
3002 /* no ucode (yet) */
3003 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3004 /* destroy DMA queues */
3005 /* reset sequence */
3006
James Ketrenosb095c382005-08-24 22:04:42 -05003007 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003008 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003009 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003010 mdelay(1);
3011
3012 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003013 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003014 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003015
James Ketrenosb095c382005-08-24 22:04:42 -05003016 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003017 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003018
James Ketrenos43f66a62005-03-25 12:31:53 -06003019 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003020 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3021 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003022 mdelay(1);
3023
3024 /* write ucode */
3025 /**
3026 * @bug
3027 * Do NOT set indirect address register once and then
3028 * store data to indirect data register in the loop.
3029 * It seems very reasonable, but in this case DINO do not
3030 * accept ucode. It is essential to set address each time.
3031 */
3032 /* load new ipw uCode */
3033 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003034 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
James Ketrenosa613bff2005-08-24 21:43:11 -05003035 cpu_to_le16(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003036
James Ketrenos43f66a62005-03-25 12:31:53 -06003037 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003038 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3039 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003040
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003041 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003042
3043 /* wait for alive response */
3044 for (i = 0; i < 100; i++) {
3045 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003046 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003047 if (cr & DINO_RXFIFO_DATA)
3048 break;
3049 mdelay(1);
3050 }
3051
3052 if (cr & DINO_RXFIFO_DATA) {
3053 /* alive_command_responce size is NOT multiple of 4 */
3054 u32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003055
3056 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003057 response_buffer[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -05003058 le32_to_cpu(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003059 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003060 memcpy(&priv->dino_alive, response_buffer,
3061 sizeof(priv->dino_alive));
3062 if (priv->dino_alive.alive_command == 1
3063 && priv->dino_alive.ucode_valid == 1) {
3064 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003065 IPW_DEBUG_INFO
3066 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3067 "of %02d/%02d/%02d %02d:%02d\n",
3068 priv->dino_alive.software_revision,
3069 priv->dino_alive.software_revision,
3070 priv->dino_alive.device_identifier,
3071 priv->dino_alive.device_identifier,
3072 priv->dino_alive.time_stamp[0],
3073 priv->dino_alive.time_stamp[1],
3074 priv->dino_alive.time_stamp[2],
3075 priv->dino_alive.time_stamp[3],
3076 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003077 } else {
3078 IPW_DEBUG_INFO("Microcode is not alive\n");
3079 rc = -EINVAL;
3080 }
3081 } else {
3082 IPW_DEBUG_INFO("No alive response from DINO\n");
3083 rc = -ETIME;
3084 }
3085
3086 /* disable DINO, otherwise for some reason
3087 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003088 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003089
James Ketrenos43f66a62005-03-25 12:31:53 -06003090 return rc;
3091}
3092
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003093static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003094{
3095 int rc = -1;
3096 int offset = 0;
3097 struct fw_chunk *chunk;
3098 dma_addr_t shared_phys;
3099 u8 *shared_virt;
3100
3101 IPW_DEBUG_TRACE("<< : \n");
3102 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3103
3104 if (!shared_virt)
3105 return -ENOMEM;
3106
3107 memmove(shared_virt, data, len);
3108
3109 /* Start the Dma */
3110 rc = ipw_fw_dma_enable(priv);
3111
3112 if (priv->sram_desc.last_cb_index > 0) {
3113 /* the DMA is already ready this would be a bug. */
3114 BUG();
3115 goto out;
3116 }
3117
3118 do {
3119 chunk = (struct fw_chunk *)(data + offset);
3120 offset += sizeof(struct fw_chunk);
3121 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003122 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003123 * offeset*/
3124 /* Dma loading */
3125 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003126 le32_to_cpu(chunk->address),
3127 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003128 if (rc) {
3129 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3130 goto out;
3131 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003132
James Ketrenosa613bff2005-08-24 21:43:11 -05003133 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003134 } while (offset < len);
3135
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003136 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003137 rc = ipw_fw_dma_kick(priv);
3138 if (rc) {
3139 IPW_ERROR("dmaKick Failed\n");
3140 goto out;
3141 }
3142
3143 rc = ipw_fw_dma_wait(priv);
3144 if (rc) {
3145 IPW_ERROR("dmaWaitSync Failed\n");
3146 goto out;
3147 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003148 out:
3149 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003150 return rc;
3151}
3152
3153/* stop nic */
3154static int ipw_stop_nic(struct ipw_priv *priv)
3155{
3156 int rc = 0;
3157
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003158 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003159 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003160
James Ketrenosb095c382005-08-24 22:04:42 -05003161 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3162 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003163 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003164 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003165 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003166 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003167
James Ketrenosb095c382005-08-24 22:04:42 -05003168 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003169
James Ketrenos43f66a62005-03-25 12:31:53 -06003170 return rc;
3171}
3172
3173static void ipw_start_nic(struct ipw_priv *priv)
3174{
3175 IPW_DEBUG_TRACE(">>\n");
3176
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003177 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003178 ipw_clear_bit(priv, IPW_RESET_REG,
3179 IPW_RESET_REG_MASTER_DISABLED |
3180 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003181 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003182
James Ketrenos43f66a62005-03-25 12:31:53 -06003183 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003184 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3185 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003186
3187 IPW_DEBUG_TRACE("<<\n");
3188}
Jeff Garzikbf794512005-07-31 13:07:26 -04003189
James Ketrenos43f66a62005-03-25 12:31:53 -06003190static int ipw_init_nic(struct ipw_priv *priv)
3191{
3192 int rc;
3193
3194 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003195 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003196 /*prvHwInitNic */
3197 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003198 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003199
3200 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003201 ipw_write32(priv, IPW_READ_INT_REGISTER,
3202 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003203
3204 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003205 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3206 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003207 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003208 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3209
3210 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003211 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003212
3213 udelay(10);
3214
3215 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003216 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003217
3218 IPW_DEBUG_TRACE(">>\n");
3219 return 0;
3220}
3221
Jeff Garzikbf794512005-07-31 13:07:26 -04003222/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003223 * Probe is an ok place to call this from.
3224 */
3225static int ipw_reset_nic(struct ipw_priv *priv)
3226{
3227 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003228 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003229
3230 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003231
James Ketrenos43f66a62005-03-25 12:31:53 -06003232 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003233
James Ketrenosa613bff2005-08-24 21:43:11 -05003234 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003235 /* Clear the 'host command active' bit... */
3236 priv->status &= ~STATUS_HCMD_ACTIVE;
3237 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003238 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3239 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003240 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003241
3242 IPW_DEBUG_TRACE("<<\n");
3243 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003244}
James Ketrenos43f66a62005-03-25 12:31:53 -06003245
James Ketrenos9006ea72006-03-08 03:22:28 +08003246
3247struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003248 __le32 ver;
3249 __le32 boot_size;
3250 __le32 ucode_size;
3251 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003252 u8 data[0];
3253};
3254
Jeff Garzikbf794512005-07-31 13:07:26 -04003255static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003256 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003257{
James Ketrenos9006ea72006-03-08 03:22:28 +08003258 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003259 int rc;
3260
3261 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003262 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003263 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003264 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003265 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003266 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003267
James Ketrenos9006ea72006-03-08 03:22:28 +08003268 if ((*raw)->size < sizeof(*fw)) {
3269 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003270 return -EINVAL;
3271 }
3272
James Ketrenos9006ea72006-03-08 03:22:28 +08003273 fw = (void *)(*raw)->data;
3274
Zhu Yi0070f8c2006-04-13 17:20:12 +08003275 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3276 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003277 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3278 name, (*raw)->size);
3279 return -EINVAL;
3280 }
3281
3282 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003283 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003284 le32_to_cpu(fw->ver) >> 16,
3285 le32_to_cpu(fw->ver) & 0xff,
3286 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003287 return 0;
3288}
3289
James Ketrenosb095c382005-08-24 22:04:42 -05003290#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003291
Arjan van de Ven858119e2006-01-14 13:20:43 -08003292static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003293 struct ipw_rx_queue *rxq)
3294{
3295 unsigned long flags;
3296 int i;
3297
3298 spin_lock_irqsave(&rxq->lock, flags);
3299
3300 INIT_LIST_HEAD(&rxq->rx_free);
3301 INIT_LIST_HEAD(&rxq->rx_used);
3302
3303 /* Fill the rx_used queue with _all_ of the Rx buffers */
3304 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3305 /* In the reset function, these buffers may have been allocated
3306 * to an SKB, so we need to unmap and free potential storage */
3307 if (rxq->pool[i].skb != NULL) {
3308 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003309 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003310 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003311 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003312 }
3313 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3314 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003315
James Ketrenos43f66a62005-03-25 12:31:53 -06003316 /* Set us so that we have processed and used all buffers, but have
3317 * not restocked the Rx queue with fresh buffers */
3318 rxq->read = rxq->write = 0;
3319 rxq->processed = RX_QUEUE_SIZE - 1;
3320 rxq->free_count = 0;
3321 spin_unlock_irqrestore(&rxq->lock, flags);
3322}
3323
3324#ifdef CONFIG_PM
3325static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003326static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003327
3328static void free_firmware(void)
3329{
3330 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003331 release_firmware(raw);
3332 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003333 fw_loaded = 0;
3334 }
3335}
3336#else
3337#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003338#endif
3339
3340static int ipw_load(struct ipw_priv *priv)
3341{
3342#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003343 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003344#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003345 struct ipw_fw *fw;
3346 u8 *boot_img, *ucode_img, *fw_img;
3347 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003348 int rc = 0, retries = 3;
3349
Zhu Yi397ae122006-01-24 16:37:22 +08003350 switch (priv->ieee->iw_mode) {
3351 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003352 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003353 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003354#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003355 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003356 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003357 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003358#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003359 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003360 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003361 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003362 }
Zhu Yi397ae122006-01-24 16:37:22 +08003363
James Ketrenos9006ea72006-03-08 03:22:28 +08003364 if (!name) {
3365 rc = -EINVAL;
3366 goto error;
3367 }
3368
3369#ifdef CONFIG_PM
3370 if (!fw_loaded) {
3371#endif
3372 rc = ipw_get_fw(priv, &raw, name);
3373 if (rc < 0)
3374 goto error;
3375#ifdef CONFIG_PM
3376 }
3377#endif
3378
3379 fw = (void *)raw->data;
3380 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003381 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3382 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3383 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003384
Zhu Yi397ae122006-01-24 16:37:22 +08003385 if (rc < 0)
3386 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003387
3388 if (!priv->rxq)
3389 priv->rxq = ipw_rx_queue_alloc(priv);
3390 else
3391 ipw_rx_queue_reset(priv, priv->rxq);
3392 if (!priv->rxq) {
3393 IPW_ERROR("Unable to initialize Rx queue\n");
3394 goto error;
3395 }
3396
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003397 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003398 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003399 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003400 priv->status &= ~STATUS_INT_ENABLED;
3401
3402 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003403 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003404
James Ketrenos43f66a62005-03-25 12:31:53 -06003405 ipw_stop_nic(priv);
3406
3407 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003408 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003409 IPW_ERROR("Unable to reset NIC\n");
3410 goto error;
3411 }
3412
James Ketrenosb095c382005-08-24 22:04:42 -05003413 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3414 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003415
3416 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003417 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003418 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003419 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003420 goto error;
3421 }
3422
3423 /* kick start the device */
3424 ipw_start_nic(priv);
3425
Zhu Yic7b6a672006-01-24 16:37:05 +08003426 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003427 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3428 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003429 if (rc < 0) {
3430 IPW_ERROR("device failed to boot initial fw image\n");
3431 goto error;
3432 }
3433 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3434
Jeff Garzikbf794512005-07-31 13:07:26 -04003435 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003436 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003437
3438 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003439 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003440 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003441 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003442 goto error;
3443 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003444
James Ketrenos43f66a62005-03-25 12:31:53 -06003445 /* stop nic */
3446 ipw_stop_nic(priv);
3447
3448 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003449 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003450 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003451 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003452 goto error;
3453 }
Zhu Yi397ae122006-01-24 16:37:22 +08003454#ifdef CONFIG_PM
3455 fw_loaded = 1;
3456#endif
3457
James Ketrenos43f66a62005-03-25 12:31:53 -06003458 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3459
3460 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003461 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003462 IPW_ERROR("Unable to initialize queues\n");
3463 goto error;
3464 }
3465
3466 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003467 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003468 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003469 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003470
James Ketrenos43f66a62005-03-25 12:31:53 -06003471 /* kick start the device */
3472 ipw_start_nic(priv);
3473
James Ketrenosb095c382005-08-24 22:04:42 -05003474 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003475 if (retries > 0) {
3476 IPW_WARNING("Parity error. Retrying init.\n");
3477 retries--;
3478 goto retry;
3479 }
3480
3481 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3482 rc = -EIO;
3483 goto error;
3484 }
3485
3486 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003487 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3488 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003489 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003490 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003491 goto error;
3492 }
3493 IPW_DEBUG_INFO("device response after %dms\n", rc);
3494
3495 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003496 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003497
3498 /* read eeprom data and initialize the eeprom region of sram */
3499 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003500 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003501
3502 /* enable interrupts */
3503 ipw_enable_interrupts(priv);
3504
3505 /* Ensure our queue has valid packets */
3506 ipw_rx_queue_replenish(priv);
3507
James Ketrenosb095c382005-08-24 22:04:42 -05003508 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003509
3510 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003511 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003512
3513#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003514 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003515#endif
3516 return 0;
3517
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003518 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003519 if (priv->rxq) {
3520 ipw_rx_queue_free(priv, priv->rxq);
3521 priv->rxq = NULL;
3522 }
3523 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003524 if (raw)
3525 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003526#ifdef CONFIG_PM
3527 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003528 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003529#endif
3530
3531 return rc;
3532}
3533
Jeff Garzikbf794512005-07-31 13:07:26 -04003534/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003535 * DMA services
3536 *
3537 * Theory of operation
3538 *
3539 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3540 * 2 empty entries always kept in the buffer to protect from overflow.
3541 *
3542 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003543 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3544 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003545 * Tx queue resumed.
3546 *
3547 * The IPW operates with six queues, one receive queue in the device's
3548 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003549 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003550 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003551 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003552 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003553 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003554 * we only utilize the first data transmit queue (queue1).
3555 */
3556
3557/**
3558 * Driver allocates buffers of this size for Rx
3559 */
3560
3561static inline int ipw_queue_space(const struct clx2_queue *q)
3562{
3563 int s = q->last_used - q->first_empty;
3564 if (s <= 0)
3565 s += q->n_bd;
3566 s -= 2; /* keep some reserve to not confuse empty and full situations */
3567 if (s < 0)
3568 s = 0;
3569 return s;
3570}
3571
3572static inline int ipw_queue_inc_wrap(int index, int n_bd)
3573{
3574 return (++index == n_bd) ? 0 : index;
3575}
3576
3577/**
3578 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003579 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003580 * @param q queue to init
3581 * @param count Number of BD's to allocate. Should be power of 2
3582 * @param read_register Address for 'read' register
3583 * (not offset within BAR, full address)
3584 * @param write_register Address for 'write' register
3585 * (not offset within BAR, full address)
3586 * @param base_register Address for 'base' register
3587 * (not offset within BAR, full address)
3588 * @param size Address for 'size' register
3589 * (not offset within BAR, full address)
3590 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003591static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003592 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003593{
3594 q->n_bd = count;
3595
3596 q->low_mark = q->n_bd / 4;
3597 if (q->low_mark < 4)
3598 q->low_mark = 4;
3599
3600 q->high_mark = q->n_bd / 8;
3601 if (q->high_mark < 2)
3602 q->high_mark = 2;
3603
3604 q->first_empty = q->last_used = 0;
3605 q->reg_r = read;
3606 q->reg_w = write;
3607
3608 ipw_write32(priv, base, q->dma_addr);
3609 ipw_write32(priv, size, count);
3610 ipw_write32(priv, read, 0);
3611 ipw_write32(priv, write, 0);
3612
3613 _ipw_read32(priv, 0x90);
3614}
3615
Jeff Garzikbf794512005-07-31 13:07:26 -04003616static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003617 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003618 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003619{
3620 struct pci_dev *dev = priv->pci_dev;
3621
3622 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3623 if (!q->txb) {
3624 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3625 return -ENOMEM;
3626 }
3627
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003628 q->bd =
3629 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003630 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003631 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003632 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003633 kfree(q->txb);
3634 q->txb = NULL;
3635 return -ENOMEM;
3636 }
3637
3638 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3639 return 0;
3640}
3641
3642/**
3643 * Free one TFD, those at index [txq->q.last_used].
3644 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003645 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003646 * @param dev
3647 * @param txq
3648 */
3649static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3650 struct clx2_tx_queue *txq)
3651{
3652 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3653 struct pci_dev *dev = priv->pci_dev;
3654 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003655
James Ketrenos43f66a62005-03-25 12:31:53 -06003656 /* classify bd */
3657 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3658 /* nothing to cleanup after for host commands */
3659 return;
3660
3661 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003662 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3663 IPW_ERROR("Too many chunks: %i\n",
3664 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003665 /** @todo issue fatal error, it is quite serious situation */
3666 return;
3667 }
3668
3669 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003670 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3671 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3672 le16_to_cpu(bd->u.data.chunk_len[i]),
3673 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003674 if (txq->txb[txq->q.last_used]) {
3675 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3676 txq->txb[txq->q.last_used] = NULL;
3677 }
3678 }
3679}
3680
3681/**
3682 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003683 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003684 * Empty queue by removing and destroying all BD's.
3685 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003686 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003687 * @param dev
3688 * @param q
3689 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003690static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003691{
3692 struct clx2_queue *q = &txq->q;
3693 struct pci_dev *dev = priv->pci_dev;
3694
Jeff Garzikbf794512005-07-31 13:07:26 -04003695 if (q->n_bd == 0)
3696 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003697
3698 /* first, empty all BD's */
3699 for (; q->first_empty != q->last_used;
3700 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3701 ipw_queue_tx_free_tfd(priv, txq);
3702 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003703
James Ketrenos43f66a62005-03-25 12:31:53 -06003704 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003705 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003706 q->dma_addr);
3707 kfree(txq->txb);
3708
3709 /* 0 fill whole structure */
3710 memset(txq, 0, sizeof(*txq));
3711}
3712
James Ketrenos43f66a62005-03-25 12:31:53 -06003713/**
3714 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003715 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003716 * @param priv
3717 */
3718static void ipw_tx_queue_free(struct ipw_priv *priv)
3719{
3720 /* Tx CMD queue */
3721 ipw_queue_tx_free(priv, &priv->txq_cmd);
3722
3723 /* Tx queues */
3724 ipw_queue_tx_free(priv, &priv->txq[0]);
3725 ipw_queue_tx_free(priv, &priv->txq[1]);
3726 ipw_queue_tx_free(priv, &priv->txq[2]);
3727 ipw_queue_tx_free(priv, &priv->txq[3]);
3728}
3729
Arjan van de Ven858119e2006-01-14 13:20:43 -08003730static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003731{
3732 /* First 3 bytes are manufacturer */
3733 bssid[0] = priv->mac_addr[0];
3734 bssid[1] = priv->mac_addr[1];
3735 bssid[2] = priv->mac_addr[2];
3736
3737 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003738 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003739
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003740 bssid[0] &= 0xfe; /* clear multicast bit */
3741 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003742}
3743
Arjan van de Ven858119e2006-01-14 13:20:43 -08003744static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003745{
3746 struct ipw_station_entry entry;
3747 int i;
3748
3749 for (i = 0; i < priv->num_stations; i++) {
3750 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3751 /* Another node is active in network */
3752 priv->missed_adhoc_beacons = 0;
3753 if (!(priv->config & CFG_STATIC_CHANNEL))
3754 /* when other nodes drop out, we drop out */
3755 priv->config &= ~CFG_ADHOC_PERSIST;
3756
3757 return i;
3758 }
3759 }
3760
3761 if (i == MAX_STATIONS)
3762 return IPW_INVALID_STATION;
3763
3764 IPW_DEBUG_SCAN("Adding AdHoc station: " MAC_FMT "\n", MAC_ARG(bssid));
3765
3766 entry.reserved = 0;
3767 entry.support_mode = 0;
3768 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3769 memcpy(priv->stations[i], bssid, ETH_ALEN);
3770 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003771 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003772 priv->num_stations++;
3773
3774 return i;
3775}
3776
Arjan van de Ven858119e2006-01-14 13:20:43 -08003777static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003778{
3779 int i;
3780
Jeff Garzikbf794512005-07-31 13:07:26 -04003781 for (i = 0; i < priv->num_stations; i++)
3782 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003783 return i;
3784
3785 return IPW_INVALID_STATION;
3786}
3787
3788static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3789{
3790 int err;
3791
Hong Liu7b996592005-08-25 17:36:13 +08003792 if (priv->status & STATUS_ASSOCIATING) {
3793 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3794 queue_work(priv->workqueue, &priv->disassociate);
3795 return;
3796 }
3797
3798 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003799 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3800 return;
3801 }
3802
3803 IPW_DEBUG_ASSOC("Disassocation attempt from " MAC_FMT " "
3804 "on channel %d.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04003805 MAC_ARG(priv->assoc_request.bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06003806 priv->assoc_request.channel);
3807
3808 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3809 priv->status |= STATUS_DISASSOCIATING;
3810
3811 if (quiet)
3812 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3813 else
3814 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003815
James Ketrenos43f66a62005-03-25 12:31:53 -06003816 err = ipw_send_associate(priv, &priv->assoc_request);
3817 if (err) {
3818 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3819 "failed.\n");
3820 return;
3821 }
3822
3823}
3824
James Ketrenosc848d0a2005-08-24 21:56:24 -05003825static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003826{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003827 struct ipw_priv *priv = data;
3828 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3829 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003830 ipw_send_disassociate(data, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003831 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003832}
3833
James Ketrenosc848d0a2005-08-24 21:56:24 -05003834static void ipw_bg_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003835{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003836 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08003837 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003838 ipw_disassociate(data);
Zhu Yi46441512006-01-24 16:37:59 +08003839 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003840}
3841
Zhu Yid8bad6d2005-07-13 12:25:38 -05003842static void ipw_system_config(void *data)
3843{
3844 struct ipw_priv *priv = data;
Zhu Yid685b8c2006-04-13 17:20:27 +08003845
3846#ifdef CONFIG_IPW2200_PROMISCUOUS
3847 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3848 priv->sys_config.accept_all_data_frames = 1;
3849 priv->sys_config.accept_non_directed_frames = 1;
3850 priv->sys_config.accept_all_mgmt_bcpr = 1;
3851 priv->sys_config.accept_all_mgmt_frames = 1;
3852 }
3853#endif
3854
3855 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003856}
3857
3858struct ipw_status_code {
3859 u16 status;
3860 const char *reason;
3861};
3862
3863static const struct ipw_status_code ipw_status_codes[] = {
3864 {0x00, "Successful"},
3865 {0x01, "Unspecified failure"},
3866 {0x0A, "Cannot support all requested capabilities in the "
3867 "Capability information field"},
3868 {0x0B, "Reassociation denied due to inability to confirm that "
3869 "association exists"},
3870 {0x0C, "Association denied due to reason outside the scope of this "
3871 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003872 {0x0D,
3873 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003874 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003875 {0x0E,
3876 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003877 "transaction sequence number out of expected sequence"},
3878 {0x0F, "Authentication rejected because of challenge failure"},
3879 {0x10, "Authentication rejected due to timeout waiting for next "
3880 "frame in sequence"},
3881 {0x11, "Association denied because AP is unable to handle additional "
3882 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003883 {0x12,
3884 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003885 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003886 {0x13,
3887 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003888 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003889 {0x14,
3890 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003891 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003892 {0x15,
3893 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003894 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003895 {0x19,
3896 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003897 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003898 {0x1A,
3899 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003900 "DSSS-OFDM operation"},
3901 {0x28, "Invalid Information Element"},
3902 {0x29, "Group Cipher is not valid"},
3903 {0x2A, "Pairwise Cipher is not valid"},
3904 {0x2B, "AKMP is not valid"},
3905 {0x2C, "Unsupported RSN IE version"},
3906 {0x2D, "Invalid RSN IE Capabilities"},
3907 {0x2E, "Cipher suite is rejected per security policy"},
3908};
3909
Jeff Garzikbf794512005-07-31 13:07:26 -04003910static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003911{
3912 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003913 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003914 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003915 return ipw_status_codes[i].reason;
3916 return "Unknown status value.";
3917}
James Ketrenos43f66a62005-03-25 12:31:53 -06003918
3919static void inline average_init(struct average *avg)
3920{
3921 memset(avg, 0, sizeof(*avg));
3922}
3923
Zhu Yi00d21de2006-04-13 17:19:02 +08003924#define DEPTH_RSSI 8
3925#define DEPTH_NOISE 16
3926static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
3927{
3928 return ((depth-1)*prev_avg + val)/depth;
3929}
3930
Arjan van de Ven858119e2006-01-14 13:20:43 -08003931static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06003932{
3933 avg->sum -= avg->entries[avg->pos];
3934 avg->sum += val;
3935 avg->entries[avg->pos++] = val;
3936 if (unlikely(avg->pos == AVG_ENTRIES)) {
3937 avg->init = 1;
3938 avg->pos = 0;
3939 }
3940}
3941
Arjan van de Ven858119e2006-01-14 13:20:43 -08003942static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06003943{
3944 if (!unlikely(avg->init)) {
3945 if (avg->pos)
3946 return avg->sum / avg->pos;
3947 return 0;
3948 }
3949
3950 return avg->sum / AVG_ENTRIES;
3951}
3952
3953static void ipw_reset_stats(struct ipw_priv *priv)
3954{
3955 u32 len = sizeof(u32);
3956
3957 priv->quality = 0;
3958
3959 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08003960 priv->exp_avg_rssi = -60;
3961 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06003962
3963 priv->last_rate = 0;
3964 priv->last_missed_beacons = 0;
3965 priv->last_rx_packets = 0;
3966 priv->last_tx_packets = 0;
3967 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04003968
James Ketrenos43f66a62005-03-25 12:31:53 -06003969 /* Firmware managed, reset only when NIC is restarted, so we have to
3970 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04003971 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06003972 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04003973 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06003974 &priv->last_tx_failures, &len);
3975
3976 /* Driver managed, reset with each association */
3977 priv->missed_adhoc_beacons = 0;
3978 priv->missed_beacons = 0;
3979 priv->tx_packets = 0;
3980 priv->rx_packets = 0;
3981
3982}
3983
Arjan van de Ven858119e2006-01-14 13:20:43 -08003984static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06003985{
3986 u32 i = 0x80000000;
3987 u32 mask = priv->rates_mask;
3988 /* If currently associated in B mode, restrict the maximum
3989 * rate match to B rates */
3990 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
3991 mask &= IEEE80211_CCK_RATES_MASK;
3992
3993 /* TODO: Verify that the rate is supported by the current rates
3994 * list. */
3995
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003996 while (i && !(mask & i))
3997 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003998 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05003999 case IEEE80211_CCK_RATE_1MB_MASK:
4000 return 1000000;
4001 case IEEE80211_CCK_RATE_2MB_MASK:
4002 return 2000000;
4003 case IEEE80211_CCK_RATE_5MB_MASK:
4004 return 5500000;
4005 case IEEE80211_OFDM_RATE_6MB_MASK:
4006 return 6000000;
4007 case IEEE80211_OFDM_RATE_9MB_MASK:
4008 return 9000000;
4009 case IEEE80211_CCK_RATE_11MB_MASK:
4010 return 11000000;
4011 case IEEE80211_OFDM_RATE_12MB_MASK:
4012 return 12000000;
4013 case IEEE80211_OFDM_RATE_18MB_MASK:
4014 return 18000000;
4015 case IEEE80211_OFDM_RATE_24MB_MASK:
4016 return 24000000;
4017 case IEEE80211_OFDM_RATE_36MB_MASK:
4018 return 36000000;
4019 case IEEE80211_OFDM_RATE_48MB_MASK:
4020 return 48000000;
4021 case IEEE80211_OFDM_RATE_54MB_MASK:
4022 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004023 }
4024
Jeff Garzikbf794512005-07-31 13:07:26 -04004025 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004026 return 11000000;
4027 else
4028 return 54000000;
4029}
4030
4031static u32 ipw_get_current_rate(struct ipw_priv *priv)
4032{
4033 u32 rate, len = sizeof(rate);
4034 int err;
4035
Jeff Garzikbf794512005-07-31 13:07:26 -04004036 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004037 return 0;
4038
4039 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004040 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004041 &len);
4042 if (err) {
4043 IPW_DEBUG_INFO("failed querying ordinals.\n");
4044 return 0;
4045 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004046 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004047 return ipw_get_max_rate(priv);
4048
4049 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004050 case IPW_TX_RATE_1MB:
4051 return 1000000;
4052 case IPW_TX_RATE_2MB:
4053 return 2000000;
4054 case IPW_TX_RATE_5MB:
4055 return 5500000;
4056 case IPW_TX_RATE_6MB:
4057 return 6000000;
4058 case IPW_TX_RATE_9MB:
4059 return 9000000;
4060 case IPW_TX_RATE_11MB:
4061 return 11000000;
4062 case IPW_TX_RATE_12MB:
4063 return 12000000;
4064 case IPW_TX_RATE_18MB:
4065 return 18000000;
4066 case IPW_TX_RATE_24MB:
4067 return 24000000;
4068 case IPW_TX_RATE_36MB:
4069 return 36000000;
4070 case IPW_TX_RATE_48MB:
4071 return 48000000;
4072 case IPW_TX_RATE_54MB:
4073 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004074 }
4075
4076 return 0;
4077}
4078
James Ketrenos43f66a62005-03-25 12:31:53 -06004079#define IPW_STATS_INTERVAL (2 * HZ)
4080static void ipw_gather_stats(struct ipw_priv *priv)
4081{
4082 u32 rx_err, rx_err_delta, rx_packets_delta;
4083 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4084 u32 missed_beacons_percent, missed_beacons_delta;
4085 u32 quality = 0;
4086 u32 len = sizeof(u32);
4087 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004088 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004089 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004090 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004091
4092 if (!(priv->status & STATUS_ASSOCIATED)) {
4093 priv->quality = 0;
4094 return;
4095 }
4096
4097 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004098 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004099 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004100 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004101 priv->last_missed_beacons = priv->missed_beacons;
4102 if (priv->assoc_request.beacon_interval) {
4103 missed_beacons_percent = missed_beacons_delta *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004104 (HZ * priv->assoc_request.beacon_interval) /
4105 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004106 } else {
4107 missed_beacons_percent = 0;
4108 }
4109 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4110
4111 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4112 rx_err_delta = rx_err - priv->last_rx_err;
4113 priv->last_rx_err = rx_err;
4114
4115 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4116 tx_failures_delta = tx_failures - priv->last_tx_failures;
4117 priv->last_tx_failures = tx_failures;
4118
4119 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4120 priv->last_rx_packets = priv->rx_packets;
4121
4122 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4123 priv->last_tx_packets = priv->tx_packets;
4124
4125 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004126 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004127 * Missed beacon: 100% = 0, 0% = 70% missed
4128 * Rate: 60% = 1Mbs, 100% = Max
4129 * Rx and Tx errors represent a straight % of total Rx/Tx
4130 * RSSI: 100% = > -50, 0% = < -80
4131 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004132 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004133 * The lowest computed quality is used.
4134 *
4135 */
4136#define BEACON_THRESHOLD 5
4137 beacon_quality = 100 - missed_beacons_percent;
4138 if (beacon_quality < BEACON_THRESHOLD)
4139 beacon_quality = 0;
4140 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004141 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004142 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004143 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004144 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004145
James Ketrenos43f66a62005-03-25 12:31:53 -06004146 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004147 max_rate = ipw_get_max_rate(priv);
4148 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004149 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4150 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004151
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004152 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004153 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004154 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004155 else
4156 rx_quality = 100;
4157 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4158 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004159
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004160 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004161 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004162 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004163 else
4164 tx_quality = 100;
4165 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4166 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004167
Zhu Yi00d21de2006-04-13 17:19:02 +08004168 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004169 signal_quality =
4170 (100 *
4171 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4172 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4173 (priv->ieee->perfect_rssi - rssi) *
4174 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4175 62 * (priv->ieee->perfect_rssi - rssi))) /
4176 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4177 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4178 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004179 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004180 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004181 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004182
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004183 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004184 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004185
4186 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004187 min(rate_quality,
4188 min(tx_quality, min(rx_quality, signal_quality))));
4189 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004190 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4191 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004192 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004193 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4194 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004195 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004196 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4197 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004198 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004199 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4200 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004201 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004202 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4203 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004204
4205 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004206
4207 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004208 IPW_STATS_INTERVAL);
4209}
4210
James Ketrenosc848d0a2005-08-24 21:56:24 -05004211static void ipw_bg_gather_stats(void *data)
4212{
4213 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08004214 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004215 ipw_gather_stats(data);
Zhu Yi46441512006-01-24 16:37:59 +08004216 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004217}
4218
Ben Cahille7582562005-10-06 15:34:41 -05004219/* Missed beacon behavior:
4220 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4221 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4222 * Above disassociate threshold, give up and stop scanning.
4223 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004224static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004225 int missed_count)
4226{
4227 priv->notif_missed_beacons = missed_count;
4228
James Ketrenosafbf30a2005-08-25 00:05:33 -05004229 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004230 priv->status & STATUS_ASSOCIATED) {
4231 /* If associated and we've hit the missed
4232 * beacon threshold, disassociate, turn
4233 * off roaming, and abort any active scans */
4234 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004235 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004236 "Missed beacon: %d - disassociate\n", missed_count);
4237 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004238 if (priv->status & STATUS_SCANNING) {
4239 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4240 IPW_DL_STATE,
4241 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004242 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004243 }
4244
James Ketrenosea2b26e2005-08-24 21:25:16 -05004245 queue_work(priv->workqueue, &priv->disassociate);
4246 return;
4247 }
4248
4249 if (priv->status & STATUS_ROAMING) {
4250 /* If we are currently roaming, then just
4251 * print a debug statement... */
4252 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4253 "Missed beacon: %d - roam in progress\n",
4254 missed_count);
4255 return;
4256 }
4257
Zhu Yi4bfdb912006-01-24 16:37:16 +08004258 if (roaming &&
4259 (missed_count > priv->roaming_threshold &&
4260 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004261 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004262 * bit in the status and kick off a scan.
4263 * This can happen several times before we reach
4264 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004265 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4266 "Missed beacon: %d - initiate "
4267 "roaming\n", missed_count);
4268 if (!(priv->status & STATUS_ROAMING)) {
4269 priv->status |= STATUS_ROAMING;
4270 if (!(priv->status & STATUS_SCANNING))
4271 queue_work(priv->workqueue,
4272 &priv->request_scan);
4273 }
4274 return;
4275 }
4276
4277 if (priv->status & STATUS_SCANNING) {
4278 /* Stop scan to keep fw from getting
4279 * stuck (only if we aren't roaming --
4280 * otherwise we'll never scan more than 2 or 3
4281 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004282 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4283 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004284 queue_work(priv->workqueue, &priv->abort_scan);
4285 }
4286
4287 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004288}
4289
James Ketrenos43f66a62005-03-25 12:31:53 -06004290/**
4291 * Handle host notification packet.
4292 * Called from interrupt routine
4293 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004294static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004295 struct ipw_rx_notification *notif)
4296{
James Ketrenosa613bff2005-08-24 21:43:11 -05004297 notif->size = le16_to_cpu(notif->size);
4298
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004299 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, notif->size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004300
James Ketrenos43f66a62005-03-25 12:31:53 -06004301 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004302 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4303 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004304
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004305 switch (assoc->state) {
4306 case CMAS_ASSOCIATED:{
4307 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4308 IPW_DL_ASSOC,
4309 "associated: '%s' " MAC_FMT
4310 " \n",
4311 escape_essid(priv->essid,
4312 priv->essid_len),
4313 MAC_ARG(priv->bssid));
Jeff Garzikbf794512005-07-31 13:07:26 -04004314
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004315 switch (priv->ieee->iw_mode) {
4316 case IW_MODE_INFRA:
4317 memcpy(priv->ieee->bssid,
4318 priv->bssid, ETH_ALEN);
4319 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004320
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004321 case IW_MODE_ADHOC:
4322 memcpy(priv->ieee->bssid,
4323 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004324
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004325 /* clear out the station table */
4326 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004327
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004328 IPW_DEBUG_ASSOC
4329 ("queueing adhoc check\n");
4330 queue_delayed_work(priv->
4331 workqueue,
4332 &priv->
4333 adhoc_check,
4334 priv->
4335 assoc_request.
4336 beacon_interval);
4337 break;
4338 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004339
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004340 priv->status &= ~STATUS_ASSOCIATING;
4341 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004342 queue_work(priv->workqueue,
4343 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004344
Zhu Yie43e3c12006-04-13 17:20:45 +08004345#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004346#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
4347 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_ctl))
4348 if ((priv->status & STATUS_AUTH) &&
4349 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4350 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004351 if ((sizeof
4352 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004353 ieee80211_assoc_response)
James Ketrenosb095c382005-08-24 22:04:42 -05004354 <= notif->size)
4355 && (notif->size <= 2314)) {
4356 struct
4357 ieee80211_rx_stats
4358 stats = {
4359 .len =
4360 notif->
4361 size - 1,
4362 };
4363
4364 IPW_DEBUG_QOS
4365 ("QoS Associate "
4366 "size %d\n",
4367 notif->size);
4368 ieee80211_rx_mgt(priv->
4369 ieee,
4370 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004371 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004372 *)
4373 &notif->u.raw, &stats);
4374 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004375 }
James Ketrenosb095c382005-08-24 22:04:42 -05004376#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004377
James Ketrenosa613bff2005-08-24 21:43:11 -05004378 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004379
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004380 break;
4381 }
4382
4383 case CMAS_AUTHENTICATED:{
4384 if (priv->
4385 status & (STATUS_ASSOCIATED |
4386 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004387 struct notif_authenticate *auth
4388 = &notif->u.auth;
4389 IPW_DEBUG(IPW_DL_NOTIF |
4390 IPW_DL_STATE |
4391 IPW_DL_ASSOC,
4392 "deauthenticated: '%s' "
4393 MAC_FMT
4394 ": (0x%04X) - %s \n",
4395 escape_essid(priv->
4396 essid,
4397 priv->
4398 essid_len),
4399 MAC_ARG(priv->bssid),
4400 ntohs(auth->status),
4401 ipw_get_status_code
4402 (ntohs
4403 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004404
4405 priv->status &=
4406 ~(STATUS_ASSOCIATING |
4407 STATUS_AUTH |
4408 STATUS_ASSOCIATED);
4409
James Ketrenosa613bff2005-08-24 21:43:11 -05004410 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004411 break;
4412 }
4413
4414 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4415 IPW_DL_ASSOC,
4416 "authenticated: '%s' " MAC_FMT
4417 "\n",
4418 escape_essid(priv->essid,
4419 priv->essid_len),
4420 MAC_ARG(priv->bssid));
4421 break;
4422 }
4423
4424 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004425 if (priv->status & STATUS_AUTH) {
4426 struct
4427 ieee80211_assoc_response
4428 *resp;
4429 resp =
4430 (struct
4431 ieee80211_assoc_response
4432 *)&notif->u.raw;
4433 IPW_DEBUG(IPW_DL_NOTIF |
4434 IPW_DL_STATE |
4435 IPW_DL_ASSOC,
4436 "association failed (0x%04X): %s\n",
4437 ntohs(resp->status),
4438 ipw_get_status_code
4439 (ntohs
4440 (resp->status)));
4441 }
4442
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004443 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4444 IPW_DL_ASSOC,
4445 "disassociated: '%s' " MAC_FMT
4446 " \n",
4447 escape_essid(priv->essid,
4448 priv->essid_len),
4449 MAC_ARG(priv->bssid));
4450
4451 priv->status &=
4452 ~(STATUS_DISASSOCIATING |
4453 STATUS_ASSOCIATING |
4454 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004455 if (priv->assoc_network
4456 && (priv->assoc_network->
4457 capability &
4458 WLAN_CAPABILITY_IBSS))
4459 ipw_remove_current_network
4460 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004461
James Ketrenosa613bff2005-08-24 21:43:11 -05004462 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004463
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004464 break;
4465 }
4466
James Ketrenosb095c382005-08-24 22:04:42 -05004467 case CMAS_RX_ASSOC_RESP:
4468 break;
4469
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004470 default:
4471 IPW_ERROR("assoc: unknown (%d)\n",
4472 assoc->state);
4473 break;
4474 }
4475
James Ketrenos43f66a62005-03-25 12:31:53 -06004476 break;
4477 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004478
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004479 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4480 struct notif_authenticate *auth = &notif->u.auth;
4481 switch (auth->state) {
4482 case CMAS_AUTHENTICATED:
4483 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4484 "authenticated: '%s' " MAC_FMT " \n",
4485 escape_essid(priv->essid,
4486 priv->essid_len),
4487 MAC_ARG(priv->bssid));
4488 priv->status |= STATUS_AUTH;
4489 break;
4490
4491 case CMAS_INIT:
4492 if (priv->status & STATUS_AUTH) {
4493 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4494 IPW_DL_ASSOC,
4495 "authentication failed (0x%04X): %s\n",
4496 ntohs(auth->status),
4497 ipw_get_status_code(ntohs
4498 (auth->
4499 status)));
4500 }
4501 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4502 IPW_DL_ASSOC,
4503 "deauthenticated: '%s' " MAC_FMT "\n",
4504 escape_essid(priv->essid,
4505 priv->essid_len),
4506 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06004507
4508 priv->status &= ~(STATUS_ASSOCIATING |
4509 STATUS_AUTH |
4510 STATUS_ASSOCIATED);
4511
James Ketrenosa613bff2005-08-24 21:43:11 -05004512 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004513 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004514
4515 case CMAS_TX_AUTH_SEQ_1:
4516 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4517 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4518 break;
4519 case CMAS_RX_AUTH_SEQ_2:
4520 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4521 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4522 break;
4523 case CMAS_AUTH_SEQ_1_PASS:
4524 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4525 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4526 break;
4527 case CMAS_AUTH_SEQ_1_FAIL:
4528 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4529 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4530 break;
4531 case CMAS_TX_AUTH_SEQ_3:
4532 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4533 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4534 break;
4535 case CMAS_RX_AUTH_SEQ_4:
4536 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4537 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4538 break;
4539 case CMAS_AUTH_SEQ_2_PASS:
4540 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4541 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4542 break;
4543 case CMAS_AUTH_SEQ_2_FAIL:
4544 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4545 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4546 break;
4547 case CMAS_TX_ASSOC:
4548 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4549 IPW_DL_ASSOC, "TX_ASSOC\n");
4550 break;
4551 case CMAS_RX_ASSOC_RESP:
4552 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4553 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004554
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004555 break;
4556 case CMAS_ASSOCIATED:
4557 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4558 IPW_DL_ASSOC, "ASSOCIATED\n");
4559 break;
4560 default:
4561 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4562 auth->state);
4563 break;
4564 }
4565 break;
4566 }
4567
4568 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4569 struct notif_channel_result *x =
4570 &notif->u.channel_result;
4571
4572 if (notif->size == sizeof(*x)) {
4573 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4574 x->channel_num);
4575 } else {
4576 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4577 "(should be %zd)\n",
4578 notif->size, sizeof(*x));
4579 }
4580 break;
4581 }
4582
4583 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4584 struct notif_scan_complete *x = &notif->u.scan_complete;
4585 if (notif->size == sizeof(*x)) {
4586 IPW_DEBUG_SCAN
4587 ("Scan completed: type %d, %d channels, "
4588 "%d status\n", x->scan_type,
4589 x->num_channels, x->status);
4590 } else {
4591 IPW_ERROR("Scan completed of wrong size %d "
4592 "(should be %zd)\n",
4593 notif->size, sizeof(*x));
4594 }
4595
4596 priv->status &=
4597 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4598
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004599 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004600 cancel_delayed_work(&priv->scan_check);
4601
James Ketrenosb095c382005-08-24 22:04:42 -05004602 if (priv->status & STATUS_EXIT_PENDING)
4603 break;
4604
4605 priv->ieee->scans++;
4606
4607#ifdef CONFIG_IPW2200_MONITOR
4608 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004609 priv->status |= STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004610 queue_work(priv->workqueue,
4611 &priv->request_scan);
4612 break;
4613 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004614 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004615#endif /* CONFIG_IPW2200_MONITOR */
4616
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004617 if (!(priv->status & (STATUS_ASSOCIATED |
4618 STATUS_ASSOCIATING |
4619 STATUS_ROAMING |
4620 STATUS_DISASSOCIATING)))
4621 queue_work(priv->workqueue, &priv->associate);
4622 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004623 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4624 /* If a scan completed and we are in roam mode, then
4625 * the scan that completed was the one requested as a
4626 * result of entering roam... so, schedule the
4627 * roam work */
4628 queue_work(priv->workqueue,
4629 &priv->roam);
4630 else
4631 /* Don't schedule if we aborted the scan */
4632 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004633 } else if (priv->status & STATUS_SCAN_PENDING)
4634 queue_work(priv->workqueue,
4635 &priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004636 else if (priv->config & CFG_BACKGROUND_SCAN
4637 && priv->status & STATUS_ASSOCIATED)
4638 queue_delayed_work(priv->workqueue,
4639 &priv->request_scan, HZ);
Zhu Yi07f02e42006-04-13 17:19:25 +08004640
4641 /* Send an empty event to user space.
4642 * We don't send the received data on the event because
4643 * it would require us to do complex transcoding, and
4644 * we want to minimise the work done in the irq handler
4645 * Use a request to extract the data.
4646 * Also, we generate this even for any scan, regardless
4647 * on how the scan was initiated. User space can just
4648 * sync on periodic scan to get fresh data...
4649 * Jean II */
4650 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE) {
4651 union iwreq_data wrqu;
4652
4653 wrqu.data.length = 0;
4654 wrqu.data.flags = 0;
4655 wireless_send_event(priv->net_dev, SIOCGIWSCAN,
4656 &wrqu, NULL);
4657 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004658 break;
4659 }
4660
4661 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4662 struct notif_frag_length *x = &notif->u.frag_len;
4663
James Ketrenosa613bff2005-08-24 21:43:11 -05004664 if (notif->size == sizeof(*x))
4665 IPW_ERROR("Frag length: %d\n",
4666 le16_to_cpu(x->frag_length));
4667 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004668 IPW_ERROR("Frag length of wrong size %d "
4669 "(should be %zd)\n",
4670 notif->size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004671 break;
4672 }
4673
4674 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4675 struct notif_link_deterioration *x =
4676 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004677
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004678 if (notif->size == sizeof(*x)) {
4679 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004680 "link deterioration: type %d, cnt %d\n",
4681 x->silence_notification_type,
4682 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004683 memcpy(&priv->last_link_deterioration, x,
4684 sizeof(*x));
4685 } else {
4686 IPW_ERROR("Link Deterioration of wrong size %d "
4687 "(should be %zd)\n",
4688 notif->size, sizeof(*x));
4689 }
4690 break;
4691 }
4692
4693 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4694 IPW_ERROR("Dino config\n");
4695 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004696 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004697 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004698
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004699 break;
4700 }
4701
4702 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4703 struct notif_beacon_state *x = &notif->u.beacon_state;
4704 if (notif->size != sizeof(*x)) {
4705 IPW_ERROR
4706 ("Beacon state of wrong size %d (should "
4707 "be %zd)\n", notif->size, sizeof(*x));
4708 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004709 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004710
James Ketrenosa613bff2005-08-24 21:43:11 -05004711 if (le32_to_cpu(x->state) ==
4712 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4713 ipw_handle_missed_beacon(priv,
4714 le32_to_cpu(x->
4715 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004716
James Ketrenos43f66a62005-03-25 12:31:53 -06004717 break;
4718 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004719
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004720 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4721 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
4722 if (notif->size == sizeof(*x)) {
4723 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4724 "0x%02x station %d\n",
4725 x->key_state, x->security_type,
4726 x->station_index);
4727 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004728 }
4729
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004730 IPW_ERROR
4731 ("TGi Tx Key of wrong size %d (should be %zd)\n",
4732 notif->size, sizeof(*x));
4733 break;
4734 }
4735
4736 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4737 struct notif_calibration *x = &notif->u.calibration;
4738
4739 if (notif->size == sizeof(*x)) {
4740 memcpy(&priv->calib, x, sizeof(*x));
4741 IPW_DEBUG_INFO("TODO: Calibration\n");
4742 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004743 }
4744
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004745 IPW_ERROR
4746 ("Calibration of wrong size %d (should be %zd)\n",
4747 notif->size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004748 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004749 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004750
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004751 case HOST_NOTIFICATION_NOISE_STATS:{
4752 if (notif->size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004753 priv->exp_avg_noise =
4754 exponential_average(priv->exp_avg_noise,
4755 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4756 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004757 break;
4758 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004759
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004760 IPW_ERROR
4761 ("Noise stat is wrong size %d (should be %zd)\n",
4762 notif->size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004763 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004764 }
4765
James Ketrenos43f66a62005-03-25 12:31:53 -06004766 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004767 IPW_DEBUG_NOTIF("Unknown notification: "
4768 "subtype=%d,flags=0x%2x,size=%d\n",
4769 notif->subtype, notif->flags, notif->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004770 }
4771}
4772
4773/**
4774 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004775 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004776 * @param priv
4777 * @return error code
4778 */
4779static int ipw_queue_reset(struct ipw_priv *priv)
4780{
4781 int rc = 0;
4782 /** @todo customize queue sizes */
4783 int nTx = 64, nTxCmd = 8;
4784 ipw_tx_queue_free(priv);
4785 /* Tx CMD queue */
4786 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004787 IPW_TX_CMD_QUEUE_READ_INDEX,
4788 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4789 IPW_TX_CMD_QUEUE_BD_BASE,
4790 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004791 if (rc) {
4792 IPW_ERROR("Tx Cmd queue init failed\n");
4793 goto error;
4794 }
4795 /* Tx queue(s) */
4796 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004797 IPW_TX_QUEUE_0_READ_INDEX,
4798 IPW_TX_QUEUE_0_WRITE_INDEX,
4799 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004800 if (rc) {
4801 IPW_ERROR("Tx 0 queue init failed\n");
4802 goto error;
4803 }
4804 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004805 IPW_TX_QUEUE_1_READ_INDEX,
4806 IPW_TX_QUEUE_1_WRITE_INDEX,
4807 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004808 if (rc) {
4809 IPW_ERROR("Tx 1 queue init failed\n");
4810 goto error;
4811 }
4812 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004813 IPW_TX_QUEUE_2_READ_INDEX,
4814 IPW_TX_QUEUE_2_WRITE_INDEX,
4815 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004816 if (rc) {
4817 IPW_ERROR("Tx 2 queue init failed\n");
4818 goto error;
4819 }
4820 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004821 IPW_TX_QUEUE_3_READ_INDEX,
4822 IPW_TX_QUEUE_3_WRITE_INDEX,
4823 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004824 if (rc) {
4825 IPW_ERROR("Tx 3 queue init failed\n");
4826 goto error;
4827 }
4828 /* statistics */
4829 priv->rx_bufs_min = 0;
4830 priv->rx_pend_max = 0;
4831 return rc;
4832
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004833 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004834 ipw_tx_queue_free(priv);
4835 return rc;
4836}
4837
4838/**
4839 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004840 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004841 * When FW adwances 'R' index, all entries between old and
4842 * new 'R' index need to be reclaimed. As result, some free space
4843 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004844 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004845 * @note Need to protect against garbage in 'R' index
4846 * @param priv
4847 * @param txq
4848 * @param qindex
4849 * @return Number of used entries remains in the queue
4850 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004851static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004852 struct clx2_tx_queue *txq, int qindex)
4853{
4854 u32 hw_tail;
4855 int used;
4856 struct clx2_queue *q = &txq->q;
4857
4858 hw_tail = ipw_read32(priv, q->reg_r);
4859 if (hw_tail >= q->n_bd) {
4860 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004861 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4862 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 goto done;
4864 }
4865 for (; q->last_used != hw_tail;
4866 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4867 ipw_queue_tx_free_tfd(priv, txq);
4868 priv->tx_packets++;
4869 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004870 done:
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004871 if ((ipw_queue_space(q) > q->low_mark) &&
4872 (qindex >= 0) &&
4873 (priv->status & STATUS_ASSOCIATED) && netif_running(priv->net_dev))
4874 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004875 used = q->first_empty - q->last_used;
4876 if (used < 0)
4877 used += q->n_bd;
4878
4879 return used;
4880}
4881
4882static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4883 int len, int sync)
4884{
4885 struct clx2_tx_queue *txq = &priv->txq_cmd;
4886 struct clx2_queue *q = &txq->q;
4887 struct tfd_frame *tfd;
4888
4889 if (ipw_queue_space(q) < (sync ? 1 : 2)) {
4890 IPW_ERROR("No space for Tx\n");
4891 return -EBUSY;
4892 }
4893
4894 tfd = &txq->bd[q->first_empty];
4895 txq->txb[q->first_empty] = NULL;
4896
4897 memset(tfd, 0, sizeof(*tfd));
4898 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
4899 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
4900 priv->hcmd_seq++;
4901 tfd->u.cmd.index = hcmd;
4902 tfd->u.cmd.length = len;
4903 memcpy(tfd->u.cmd.payload, buf, len);
4904 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
4905 ipw_write32(priv, q->reg_w, q->first_empty);
4906 _ipw_read32(priv, 0x90);
4907
4908 return 0;
4909}
4910
Jeff Garzikbf794512005-07-31 13:07:26 -04004911/*
James Ketrenos43f66a62005-03-25 12:31:53 -06004912 * Rx theory of operation
4913 *
4914 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05004915 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06004916 * 0 to 31
4917 *
4918 * Rx Queue Indexes
4919 * The host/firmware share two index registers for managing the Rx buffers.
4920 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004921 * The READ index maps to the first position that the firmware may be writing
4922 * to -- the driver can read up to (but not including) this position and get
4923 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06004924 * The READ index is managed by the firmware once the card is enabled.
4925 *
4926 * The WRITE index maps to the last position the driver has read from -- the
4927 * position preceding WRITE is the last slot the firmware can place a packet.
4928 *
4929 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04004930 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06004931 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004932 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06004933 * INDEX position, and WRITE to the last (READ - 1 wrapped)
4934 *
4935 * When the firmware places a packet in a buffer it will advance the READ index
4936 * and fire the RX interrupt. The driver can then query the READ index and
4937 * process as many packets as possible, moving the WRITE index forward as it
4938 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04004939 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004940 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04004941 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06004942 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04004943 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06004944 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
4945 * ipw->rxq is replenished and the READ INDEX is updated (updating the
4946 * 'processed' and 'read' driver indexes as well)
4947 * + A received packet is processed and handed to the kernel network stack,
4948 * detached from the ipw->rxq. The driver 'processed' index is updated.
4949 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04004950 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
4951 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06004952 * were enough free buffers and RX_STALLED is set it is cleared.
4953 *
4954 *
4955 * Driver sequence:
4956 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004957 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06004958 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
4959 * ipw_rx_queue_restock
4960 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
4961 * queue, updates firmware pointers, and updates
4962 * the WRITE index. If insufficient rx_free buffers
4963 * are available, schedules ipw_rx_queue_replenish
4964 *
4965 * -- enable interrupts --
4966 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04004967 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06004968 * Moves the packet buffer from queue to rx_used.
4969 * Calls ipw_rx_queue_restock to refill any empty
4970 * slots.
4971 * ...
4972 *
4973 */
4974
Jeff Garzikbf794512005-07-31 13:07:26 -04004975/*
James Ketrenos43f66a62005-03-25 12:31:53 -06004976 * If there are slots in the RX queue that need to be restocked,
4977 * and we have free pre-allocated buffers, fill the ranks as much
4978 * as we can pulling from rx_free.
4979 *
4980 * This moves the 'write' index forward to catch up with 'processed', and
4981 * also updates the memory address in the firmware to reference the new
4982 * target buffer.
4983 */
4984static void ipw_rx_queue_restock(struct ipw_priv *priv)
4985{
4986 struct ipw_rx_queue *rxq = priv->rxq;
4987 struct list_head *element;
4988 struct ipw_rx_mem_buffer *rxb;
4989 unsigned long flags;
4990 int write;
4991
4992 spin_lock_irqsave(&rxq->lock, flags);
4993 write = rxq->write;
4994 while ((rxq->write != rxq->processed) && (rxq->free_count)) {
4995 element = rxq->rx_free.next;
4996 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
4997 list_del(element);
4998
James Ketrenosb095c382005-08-24 22:04:42 -05004999 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005000 rxb->dma_addr);
5001 rxq->queue[rxq->write] = rxb;
5002 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5003 rxq->free_count--;
5004 }
5005 spin_unlock_irqrestore(&rxq->lock, flags);
5006
Jeff Garzikbf794512005-07-31 13:07:26 -04005007 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005008 * refill it */
5009 if (rxq->free_count <= RX_LOW_WATERMARK)
5010 queue_work(priv->workqueue, &priv->rx_replenish);
5011
5012 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005013 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005014 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005015}
5016
5017/*
5018 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005019 * Also restock the Rx queue via ipw_rx_queue_restock.
5020 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005021 * This is called as a scheduled work item (except for during intialization)
5022 */
5023static void ipw_rx_queue_replenish(void *data)
5024{
5025 struct ipw_priv *priv = data;
5026 struct ipw_rx_queue *rxq = priv->rxq;
5027 struct list_head *element;
5028 struct ipw_rx_mem_buffer *rxb;
5029 unsigned long flags;
5030
5031 spin_lock_irqsave(&rxq->lock, flags);
5032 while (!list_empty(&rxq->rx_used)) {
5033 element = rxq->rx_used.next;
5034 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005035 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005036 if (!rxb->skb) {
5037 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5038 priv->net_dev->name);
5039 /* We don't reschedule replenish work here -- we will
5040 * call the restock method and if it still needs
5041 * more buffers it will schedule replenish */
5042 break;
5043 }
5044 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005045
James Ketrenos43f66a62005-03-25 12:31:53 -06005046 rxb->rxb = (struct ipw_rx_buffer *)rxb->skb->data;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005047 rxb->dma_addr =
5048 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005049 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005050
James Ketrenos43f66a62005-03-25 12:31:53 -06005051 list_add_tail(&rxb->list, &rxq->rx_free);
5052 rxq->free_count++;
5053 }
5054 spin_unlock_irqrestore(&rxq->lock, flags);
5055
5056 ipw_rx_queue_restock(priv);
5057}
5058
James Ketrenosc848d0a2005-08-24 21:56:24 -05005059static void ipw_bg_rx_queue_replenish(void *data)
5060{
5061 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08005062 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005063 ipw_rx_queue_replenish(data);
Zhu Yi46441512006-01-24 16:37:59 +08005064 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005065}
5066
James Ketrenos43f66a62005-03-25 12:31:53 -06005067/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005068 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005069 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005070 * non NULL it is unmapped and freed
5071 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005072static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005073{
5074 int i;
5075
5076 if (!rxq)
5077 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005078
James Ketrenos43f66a62005-03-25 12:31:53 -06005079 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5080 if (rxq->pool[i].skb != NULL) {
5081 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005082 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005083 dev_kfree_skb(rxq->pool[i].skb);
5084 }
5085 }
5086
5087 kfree(rxq);
5088}
5089
5090static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5091{
5092 struct ipw_rx_queue *rxq;
5093 int i;
5094
Takisc75f4742005-12-01 01:41:45 -08005095 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005096 if (unlikely(!rxq)) {
5097 IPW_ERROR("memory allocation failed\n");
5098 return NULL;
5099 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005100 spin_lock_init(&rxq->lock);
5101 INIT_LIST_HEAD(&rxq->rx_free);
5102 INIT_LIST_HEAD(&rxq->rx_used);
5103
5104 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005105 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005106 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5107
5108 /* Set us so that we have processed and used all buffers, but have
5109 * not restocked the Rx queue with fresh buffers */
5110 rxq->read = rxq->write = 0;
5111 rxq->processed = RX_QUEUE_SIZE - 1;
5112 rxq->free_count = 0;
5113
5114 return rxq;
5115}
5116
5117static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5118{
5119 rate &= ~IEEE80211_BASIC_RATE_MASK;
5120 if (ieee_mode == IEEE_A) {
5121 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005122 case IEEE80211_OFDM_RATE_6MB:
5123 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005124 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005125 case IEEE80211_OFDM_RATE_9MB:
5126 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005127 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005128 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005129 return priv->
5130 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005131 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005132 return priv->
5133 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005134 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005135 return priv->
5136 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005137 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005138 return priv->
5139 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005140 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005141 return priv->
5142 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005143 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005144 return priv->
5145 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005146 default:
5147 return 0;
5148 }
5149 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005150
James Ketrenos43f66a62005-03-25 12:31:53 -06005151 /* B and G mixed */
5152 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005153 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005154 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005155 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005156 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005157 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005158 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005159 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005160 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5161 }
5162
5163 /* If we are limited to B modulations, bail at this point */
5164 if (ieee_mode == IEEE_B)
5165 return 0;
5166
5167 /* G */
5168 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005169 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005170 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005171 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005172 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005173 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005174 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005175 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005176 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005177 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005178 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005179 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005180 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005181 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005182 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005183 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005184 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5185 }
5186
5187 return 0;
5188}
5189
Jeff Garzikbf794512005-07-31 13:07:26 -04005190static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005191 const struct ieee80211_network *network,
5192 struct ipw_supported_rates *rates)
5193{
5194 int num_rates, i;
5195
5196 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005197 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005198 rates->num_rates = 0;
5199 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005200 if (!ipw_is_rate_in_mask(priv, network->mode,
5201 network->rates[i])) {
5202
James Ketrenosea2b26e2005-08-24 21:25:16 -05005203 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005204 IPW_DEBUG_SCAN("Adding masked mandatory "
5205 "rate %02X\n",
5206 network->rates[i]);
5207 rates->supported_rates[rates->num_rates++] =
5208 network->rates[i];
5209 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005210 }
5211
James Ketrenos43f66a62005-03-25 12:31:53 -06005212 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5213 network->rates[i], priv->rates_mask);
5214 continue;
5215 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005216
James Ketrenos43f66a62005-03-25 12:31:53 -06005217 rates->supported_rates[rates->num_rates++] = network->rates[i];
5218 }
5219
James Ketrenosa613bff2005-08-24 21:43:11 -05005220 num_rates = min(network->rates_ex_len,
5221 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005222 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005223 if (!ipw_is_rate_in_mask(priv, network->mode,
5224 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005225 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005226 IPW_DEBUG_SCAN("Adding masked mandatory "
5227 "rate %02X\n",
5228 network->rates_ex[i]);
5229 rates->supported_rates[rates->num_rates++] =
5230 network->rates[i];
5231 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005232 }
5233
James Ketrenos43f66a62005-03-25 12:31:53 -06005234 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5235 network->rates_ex[i], priv->rates_mask);
5236 continue;
5237 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005238
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005239 rates->supported_rates[rates->num_rates++] =
5240 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005241 }
5242
James Ketrenosea2b26e2005-08-24 21:25:16 -05005243 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005244}
5245
Arjan van de Ven858119e2006-01-14 13:20:43 -08005246static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005247 const struct ipw_supported_rates *src)
5248{
5249 u8 i;
5250 for (i = 0; i < src->num_rates; i++)
5251 dest->supported_rates[i] = src->supported_rates[i];
5252 dest->num_rates = src->num_rates;
5253}
5254
5255/* TODO: Look at sniffed packets in the air to determine if the basic rate
5256 * mask should ever be used -- right now all callers to add the scan rates are
5257 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5258static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005259 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005260{
Jeff Garzikbf794512005-07-31 13:07:26 -04005261 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005262 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005263
James Ketrenos43f66a62005-03-25 12:31:53 -06005264 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005265 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005266 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005267
5268 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005269 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005270 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005271
5272 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005273 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005274 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005275
5276 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005277 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005278 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005279}
5280
5281static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005282 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005283{
Jeff Garzikbf794512005-07-31 13:07:26 -04005284 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005285 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005286
5287 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005288 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005289 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005290
5291 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005292 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005293 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005294
5295 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005296 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005297 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005298
5299 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005300 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005301 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005302
5303 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005304 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005305 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005306
5307 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005308 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005309 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005310
5311 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005312 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005313 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005314
5315 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005316 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005317 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005318}
5319
5320struct ipw_network_match {
5321 struct ieee80211_network *network;
5322 struct ipw_supported_rates rates;
5323};
5324
James Ketrenosc848d0a2005-08-24 21:56:24 -05005325static int ipw_find_adhoc_network(struct ipw_priv *priv,
5326 struct ipw_network_match *match,
5327 struct ieee80211_network *network,
5328 int roaming)
5329{
5330 struct ipw_supported_rates rates;
5331
5332 /* Verify that this network's capability is compatible with the
5333 * current mode (AdHoc or Infrastructure) */
5334 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5335 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5336 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded due to "
5337 "capability mismatch.\n",
5338 escape_essid(network->ssid, network->ssid_len),
5339 MAC_ARG(network->bssid));
5340 return 0;
5341 }
5342
5343 /* If we do not have an ESSID for this AP, we can not associate with
5344 * it */
5345 if (network->flags & NETWORK_EMPTY_ESSID) {
5346 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5347 "because of hidden ESSID.\n",
5348 escape_essid(network->ssid, network->ssid_len),
5349 MAC_ARG(network->bssid));
5350 return 0;
5351 }
5352
5353 if (unlikely(roaming)) {
5354 /* If we are roaming, then ensure check if this is a valid
5355 * network to try and roam to */
5356 if ((network->ssid_len != match->network->ssid_len) ||
5357 memcmp(network->ssid, match->network->ssid,
5358 network->ssid_len)) {
5359 IPW_DEBUG_MERGE("Netowrk '%s (" MAC_FMT ")' excluded "
5360 "because of non-network ESSID.\n",
5361 escape_essid(network->ssid,
5362 network->ssid_len),
5363 MAC_ARG(network->bssid));
5364 return 0;
5365 }
5366 } else {
5367 /* If an ESSID has been configured then compare the broadcast
5368 * ESSID to ours */
5369 if ((priv->config & CFG_STATIC_ESSID) &&
5370 ((network->ssid_len != priv->essid_len) ||
5371 memcmp(network->ssid, priv->essid,
5372 min(network->ssid_len, priv->essid_len)))) {
5373 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005374
James Ketrenosc848d0a2005-08-24 21:56:24 -05005375 strncpy(escaped,
5376 escape_essid(network->ssid, network->ssid_len),
5377 sizeof(escaped));
5378 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5379 "because of ESSID mismatch: '%s'.\n",
5380 escaped, MAC_ARG(network->bssid),
5381 escape_essid(priv->essid,
5382 priv->essid_len));
5383 return 0;
5384 }
5385 }
5386
5387 /* If the old network rate is better than this one, don't bother
5388 * testing everything else. */
5389
5390 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005391 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5392 "current network.\n",
5393 escape_essid(match->network->ssid,
5394 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005395 return 0;
5396 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005397 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5398 "current network.\n",
5399 escape_essid(match->network->ssid,
5400 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005401 return 0;
5402 }
5403
5404 /* Now go through and see if the requested network is valid... */
5405 if (priv->ieee->scan_age != 0 &&
5406 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
5407 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005408 "because of age: %ums.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005409 escape_essid(network->ssid, network->ssid_len),
5410 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005411 jiffies_to_msecs(jiffies -
5412 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005413 return 0;
5414 }
5415
5416 if ((priv->config & CFG_STATIC_CHANNEL) &&
5417 (network->channel != priv->channel)) {
5418 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5419 "because of channel mismatch: %d != %d.\n",
5420 escape_essid(network->ssid, network->ssid_len),
5421 MAC_ARG(network->bssid),
5422 network->channel, priv->channel);
5423 return 0;
5424 }
5425
5426 /* Verify privacy compatability */
5427 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5428 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5429 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5430 "because of privacy mismatch: %s != %s.\n",
5431 escape_essid(network->ssid, network->ssid_len),
5432 MAC_ARG(network->bssid),
James Ketrenosafbf30a2005-08-25 00:05:33 -05005433 priv->
5434 capability & CAP_PRIVACY_ON ? "on" : "off",
5435 network->
5436 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5437 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005438 return 0;
5439 }
5440
5441 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5442 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5443 "because of the same BSSID match: " MAC_FMT
5444 ".\n", escape_essid(network->ssid,
5445 network->ssid_len),
5446 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
5447 return 0;
5448 }
5449
5450 /* Filter out any incompatible freq / mode combinations */
5451 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5452 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5453 "because of invalid frequency/mode "
5454 "combination.\n",
5455 escape_essid(network->ssid, network->ssid_len),
5456 MAC_ARG(network->bssid));
5457 return 0;
5458 }
5459
5460 /* Ensure that the rates supported by the driver are compatible with
5461 * this AP, including verification of basic rates (mandatory) */
5462 if (!ipw_compatible_rates(priv, network, &rates)) {
5463 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5464 "because configured rate mask excludes "
5465 "AP mandatory rate.\n",
5466 escape_essid(network->ssid, network->ssid_len),
5467 MAC_ARG(network->bssid));
5468 return 0;
5469 }
5470
5471 if (rates.num_rates == 0) {
5472 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5473 "because of no compatible rates.\n",
5474 escape_essid(network->ssid, network->ssid_len),
5475 MAC_ARG(network->bssid));
5476 return 0;
5477 }
5478
5479 /* TODO: Perform any further minimal comparititive tests. We do not
5480 * want to put too much policy logic here; intelligent scan selection
5481 * should occur within a generic IEEE 802.11 user space tool. */
5482
5483 /* Set up 'new' AP to this network */
5484 ipw_copy_rates(&match->rates, &rates);
5485 match->network = network;
5486 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' is a viable match.\n",
5487 escape_essid(network->ssid, network->ssid_len),
5488 MAC_ARG(network->bssid));
5489
5490 return 1;
5491}
5492
5493static void ipw_merge_adhoc_network(void *data)
5494{
5495 struct ipw_priv *priv = data;
5496 struct ieee80211_network *network = NULL;
5497 struct ipw_network_match match = {
5498 .network = priv->assoc_network
5499 };
5500
James Ketrenosafbf30a2005-08-25 00:05:33 -05005501 if ((priv->status & STATUS_ASSOCIATED) &&
5502 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005503 /* First pass through ROAM process -- look for a better
5504 * network */
5505 unsigned long flags;
5506
5507 spin_lock_irqsave(&priv->ieee->lock, flags);
5508 list_for_each_entry(network, &priv->ieee->network_list, list) {
5509 if (network != priv->assoc_network)
5510 ipw_find_adhoc_network(priv, &match, network,
5511 1);
5512 }
5513 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5514
5515 if (match.network == priv->assoc_network) {
5516 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5517 "merge to.\n");
5518 return;
5519 }
5520
Zhu Yi46441512006-01-24 16:37:59 +08005521 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005522 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5523 IPW_DEBUG_MERGE("remove network %s\n",
5524 escape_essid(priv->essid,
5525 priv->essid_len));
5526 ipw_remove_current_network(priv);
5527 }
5528
5529 ipw_disassociate(priv);
5530 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005531 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005532 return;
5533 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005534}
5535
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005536static int ipw_best_network(struct ipw_priv *priv,
5537 struct ipw_network_match *match,
5538 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005539{
5540 struct ipw_supported_rates rates;
5541
5542 /* Verify that this network's capability is compatible with the
5543 * current mode (AdHoc or Infrastructure) */
5544 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005545 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005546 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5547 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5548 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005549 "capability mismatch.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005550 escape_essid(network->ssid, network->ssid_len),
5551 MAC_ARG(network->bssid));
5552 return 0;
5553 }
5554
5555 /* If we do not have an ESSID for this AP, we can not associate with
5556 * it */
5557 if (network->flags & NETWORK_EMPTY_ESSID) {
5558 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5559 "because of hidden ESSID.\n",
5560 escape_essid(network->ssid, network->ssid_len),
5561 MAC_ARG(network->bssid));
5562 return 0;
5563 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005564
James Ketrenos43f66a62005-03-25 12:31:53 -06005565 if (unlikely(roaming)) {
5566 /* If we are roaming, then ensure check if this is a valid
5567 * network to try and roam to */
5568 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005569 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005570 network->ssid_len)) {
5571 IPW_DEBUG_ASSOC("Netowrk '%s (" MAC_FMT ")' excluded "
5572 "because of non-network ESSID.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04005573 escape_essid(network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005574 network->ssid_len),
5575 MAC_ARG(network->bssid));
5576 return 0;
5577 }
5578 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005579 /* If an ESSID has been configured then compare the broadcast
5580 * ESSID to ours */
5581 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005582 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005583 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005584 min(network->ssid_len, priv->essid_len)))) {
5585 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005586 strncpy(escaped,
5587 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005588 sizeof(escaped));
5589 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005590 "because of ESSID mismatch: '%s'.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005591 escaped, MAC_ARG(network->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005592 escape_essid(priv->essid,
5593 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005594 return 0;
5595 }
5596 }
5597
5598 /* If the old network rate is better than this one, don't bother
5599 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005600 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005601 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005602 strncpy(escaped,
5603 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005604 sizeof(escaped));
5605 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded because "
5606 "'%s (" MAC_FMT ")' has a stronger signal.\n",
5607 escaped, MAC_ARG(network->bssid),
5608 escape_essid(match->network->ssid,
5609 match->network->ssid_len),
5610 MAC_ARG(match->network->bssid));
5611 return 0;
5612 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005613
James Ketrenos43f66a62005-03-25 12:31:53 -06005614 /* If this network has already had an association attempt within the
5615 * last 3 seconds, do not try and associate again... */
5616 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005617 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005618 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005619 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005620 "assoc attempt).\n",
5621 escape_essid(network->ssid, network->ssid_len),
5622 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005623 jiffies_to_msecs(jiffies -
5624 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005625 return 0;
5626 }
5627
5628 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005629 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005630 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005631 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005632 "because of age: %ums.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005633 escape_essid(network->ssid, network->ssid_len),
5634 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005635 jiffies_to_msecs(jiffies -
5636 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005637 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005638 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005639
Jeff Garzikbf794512005-07-31 13:07:26 -04005640 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005641 (network->channel != priv->channel)) {
5642 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5643 "because of channel mismatch: %d != %d.\n",
5644 escape_essid(network->ssid, network->ssid_len),
5645 MAC_ARG(network->bssid),
5646 network->channel, priv->channel);
5647 return 0;
5648 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005649
James Ketrenos43f66a62005-03-25 12:31:53 -06005650 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005651 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005652 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5653 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5654 "because of privacy mismatch: %s != %s.\n",
5655 escape_essid(network->ssid, network->ssid_len),
5656 MAC_ARG(network->bssid),
Jeff Garzikbf794512005-07-31 13:07:26 -04005657 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005658 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005659 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005660 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005661 return 0;
5662 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005663
5664 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005665 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5666 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5667 "because of BSSID mismatch: " MAC_FMT ".\n",
5668 escape_essid(network->ssid, network->ssid_len),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005669 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005670 return 0;
5671 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005672
James Ketrenos43f66a62005-03-25 12:31:53 -06005673 /* Filter out any incompatible freq / mode combinations */
5674 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5675 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5676 "because of invalid frequency/mode "
5677 "combination.\n",
5678 escape_essid(network->ssid, network->ssid_len),
5679 MAC_ARG(network->bssid));
5680 return 0;
5681 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005682
Liu Hong1fe0adb2005-08-19 09:33:10 -05005683 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005684 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05005685 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5686 "because of invalid channel in current GEO\n",
5687 escape_essid(network->ssid, network->ssid_len),
5688 MAC_ARG(network->bssid));
5689 return 0;
5690 }
5691
James Ketrenosea2b26e2005-08-24 21:25:16 -05005692 /* Ensure that the rates supported by the driver are compatible with
5693 * this AP, including verification of basic rates (mandatory) */
5694 if (!ipw_compatible_rates(priv, network, &rates)) {
5695 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5696 "because configured rate mask excludes "
5697 "AP mandatory rate.\n",
5698 escape_essid(network->ssid, network->ssid_len),
5699 MAC_ARG(network->bssid));
5700 return 0;
5701 }
5702
James Ketrenos43f66a62005-03-25 12:31:53 -06005703 if (rates.num_rates == 0) {
5704 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5705 "because of no compatible rates.\n",
5706 escape_essid(network->ssid, network->ssid_len),
5707 MAC_ARG(network->bssid));
5708 return 0;
5709 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005710
James Ketrenos43f66a62005-03-25 12:31:53 -06005711 /* TODO: Perform any further minimal comparititive tests. We do not
5712 * want to put too much policy logic here; intelligent scan selection
5713 * should occur within a generic IEEE 802.11 user space tool. */
5714
5715 /* Set up 'new' AP to this network */
5716 ipw_copy_rates(&match->rates, &rates);
5717 match->network = network;
5718
5719 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' is a viable match.\n",
5720 escape_essid(network->ssid, network->ssid_len),
5721 MAC_ARG(network->bssid));
5722
5723 return 1;
5724}
5725
Jeff Garzikbf794512005-07-31 13:07:26 -04005726static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005727 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005728{
Larry Finger1867b112006-02-28 09:48:28 -06005729 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005730 int i;
5731
James Ketrenos43f66a62005-03-25 12:31:53 -06005732 /*
5733 * For the purposes of scanning, we can set our wireless mode
5734 * to trigger scans across combinations of bands, but when it
5735 * comes to creating a new ad-hoc network, we have tell the FW
5736 * exactly which band to use.
5737 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005738 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005739 * chossen band. Attempting to create a new ad-hoc network
5740 * with an invalid channel for wireless mode will trigger a
5741 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005742 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005743 */
Larry Finger1867b112006-02-28 09:48:28 -06005744 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005745 case IEEE80211_52GHZ_BAND:
5746 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005747 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005748 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005749 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5750 IPW_WARNING("Overriding invalid channel\n");
5751 priv->channel = geo->a[0].channel;
5752 }
5753 break;
5754
5755 case IEEE80211_24GHZ_BAND:
5756 if (priv->ieee->mode & IEEE_G)
5757 network->mode = IEEE_G;
5758 else
5759 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005760 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005761 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005762 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5763 IPW_WARNING("Overriding invalid channel\n");
5764 priv->channel = geo->bg[0].channel;
5765 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005766 break;
5767
5768 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005769 IPW_WARNING("Overriding invalid channel\n");
5770 if (priv->ieee->mode & IEEE_A) {
5771 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005772 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005773 } else if (priv->ieee->mode & IEEE_G) {
5774 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005775 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005776 } else {
5777 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005778 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005779 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005780 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005781 }
5782
5783 network->channel = priv->channel;
5784 priv->config |= CFG_ADHOC_PERSIST;
5785 ipw_create_bssid(priv, network->bssid);
5786 network->ssid_len = priv->essid_len;
5787 memcpy(network->ssid, priv->essid, priv->essid_len);
5788 memset(&network->stats, 0, sizeof(network->stats));
5789 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005790 if (!(priv->config & CFG_PREAMBLE_LONG))
5791 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005792 if (priv->capability & CAP_PRIVACY_ON)
5793 network->capability |= WLAN_CAPABILITY_PRIVACY;
5794 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005795 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005796 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005797 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005798 &priv->rates.supported_rates[network->rates_len],
5799 network->rates_ex_len);
5800 network->last_scanned = 0;
5801 network->flags = 0;
5802 network->last_associate = 0;
5803 network->time_stamp[0] = 0;
5804 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005805 network->beacon_interval = 100; /* Default */
5806 network->listen_interval = 10; /* Default */
5807 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005808 network->wpa_ie_len = 0;
5809 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005810}
5811
James Ketrenosb095c382005-08-24 22:04:42 -05005812static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5813{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005814 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005815
5816 if (!(priv->ieee->sec.flags & (1 << index)))
5817 return;
5818
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005819 key.key_id = index;
5820 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5821 key.security_type = type;
5822 key.station_index = 0; /* always 0 for BSS */
5823 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005824 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005825 key.tx_counter[0] = 0;
5826 key.tx_counter[1] = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005827
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005828 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005829}
5830
5831static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005832{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005833 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005834 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005835
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005836 key.cmd_id = DINO_CMD_WEP_KEY;
5837 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005838
James Ketrenosb095c382005-08-24 22:04:42 -05005839 /* Note: AES keys cannot be set for multiple times.
5840 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005841 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005842 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005843 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005844 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005845 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005846 }
5847
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005848 key.key_size = priv->ieee->sec.key_sizes[i];
5849 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005850
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005851 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005852 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005853}
5854
Zhu Yi1fbfea52005-08-05 17:22:56 +08005855static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5856{
5857 if (priv->ieee->host_encrypt)
5858 return;
5859
5860 switch (level) {
5861 case SEC_LEVEL_3:
5862 priv->sys_config.disable_unicast_decryption = 0;
5863 priv->ieee->host_decrypt = 0;
5864 break;
5865 case SEC_LEVEL_2:
5866 priv->sys_config.disable_unicast_decryption = 1;
5867 priv->ieee->host_decrypt = 1;
5868 break;
5869 case SEC_LEVEL_1:
5870 priv->sys_config.disable_unicast_decryption = 0;
5871 priv->ieee->host_decrypt = 0;
5872 break;
5873 case SEC_LEVEL_0:
5874 priv->sys_config.disable_unicast_decryption = 1;
5875 break;
5876 default:
5877 break;
5878 }
5879}
5880
5881static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5882{
5883 if (priv->ieee->host_encrypt)
5884 return;
5885
5886 switch (level) {
5887 case SEC_LEVEL_3:
5888 priv->sys_config.disable_multicast_decryption = 0;
5889 break;
5890 case SEC_LEVEL_2:
5891 priv->sys_config.disable_multicast_decryption = 1;
5892 break;
5893 case SEC_LEVEL_1:
5894 priv->sys_config.disable_multicast_decryption = 0;
5895 break;
5896 case SEC_LEVEL_0:
5897 priv->sys_config.disable_multicast_decryption = 1;
5898 break;
5899 default:
5900 break;
5901 }
5902}
5903
James Ketrenosb095c382005-08-24 22:04:42 -05005904static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
5905{
5906 switch (priv->ieee->sec.level) {
5907 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005908 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5909 ipw_send_tgi_tx_key(priv,
5910 DCT_FLAG_EXT_SECURITY_CCM,
5911 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005912
Hong Liu567deaf2005-08-31 18:07:22 +08005913 if (!priv->ieee->host_mc_decrypt)
5914 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05005915 break;
5916 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005917 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5918 ipw_send_tgi_tx_key(priv,
5919 DCT_FLAG_EXT_SECURITY_TKIP,
5920 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05005921 break;
5922 case SEC_LEVEL_1:
5923 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05005924 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
5925 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05005926 break;
5927 case SEC_LEVEL_0:
5928 default:
5929 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005930 }
5931}
5932
5933static void ipw_adhoc_check(void *data)
5934{
5935 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04005936
James Ketrenosafbf30a2005-08-25 00:05:33 -05005937 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005938 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005939 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
5940 IPW_DL_STATE | IPW_DL_ASSOC,
5941 "Missed beacon: %d - disassociate\n",
5942 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06005943 ipw_remove_current_network(priv);
5944 ipw_disassociate(priv);
5945 return;
5946 }
5947
Jeff Garzikbf794512005-07-31 13:07:26 -04005948 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
James Ketrenos43f66a62005-03-25 12:31:53 -06005949 priv->assoc_request.beacon_interval);
5950}
5951
James Ketrenosc848d0a2005-08-24 21:56:24 -05005952static void ipw_bg_adhoc_check(void *data)
5953{
5954 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08005955 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005956 ipw_adhoc_check(data);
Zhu Yi46441512006-01-24 16:37:59 +08005957 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005958}
5959
James Ketrenos43f66a62005-03-25 12:31:53 -06005960static void ipw_debug_config(struct ipw_priv *priv)
5961{
5962 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
5963 "[CFG 0x%08X]\n", priv->config);
5964 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005965 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06005966 else
5967 IPW_DEBUG_INFO("Channel unlocked.\n");
5968 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04005969 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005970 escape_essid(priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005971 else
5972 IPW_DEBUG_INFO("ESSID unlocked.\n");
5973 if (priv->config & CFG_STATIC_BSSID)
James Ketrenosea2b26e2005-08-24 21:25:16 -05005974 IPW_DEBUG_INFO("BSSID locked to " MAC_FMT "\n",
5975 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005976 else
5977 IPW_DEBUG_INFO("BSSID unlocked.\n");
5978 if (priv->capability & CAP_PRIVACY_ON)
5979 IPW_DEBUG_INFO("PRIVACY on\n");
5980 else
5981 IPW_DEBUG_INFO("PRIVACY off\n");
5982 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
5983}
James Ketrenos43f66a62005-03-25 12:31:53 -06005984
Arjan van de Ven858119e2006-01-14 13:20:43 -08005985static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06005986{
5987 /* TODO: Verify that this works... */
5988 struct ipw_fixed_rate fr = {
5989 .tx_rates = priv->rates_mask
5990 };
5991 u32 reg;
5992 u16 mask = 0;
5993
Jeff Garzikbf794512005-07-31 13:07:26 -04005994 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06005995 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04005996
James Ketrenos43f66a62005-03-25 12:31:53 -06005997 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005998 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06005999 /* IEEE_A */
6000 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6001 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006002 IPW_DEBUG_WX
6003 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006004 fr.tx_rates = 0;
6005 break;
6006 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006007
James Ketrenos43f66a62005-03-25 12:31:53 -06006008 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6009 break;
6010
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006011 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006012 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006013 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006014 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6015 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006016 IPW_DEBUG_WX
6017 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006018 fr.tx_rates = 0;
6019 }
6020 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006021 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006022
6023 /* IEEE_G */
6024 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6025 IEEE80211_OFDM_RATES_MASK)) {
6026 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006027 IPW_DEBUG_WX
6028 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006029 fr.tx_rates = 0;
6030 break;
6031 }
6032
6033 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6034 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6035 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6036 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006037
James Ketrenos43f66a62005-03-25 12:31:53 -06006038 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6039 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6040 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6041 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006042
James Ketrenos43f66a62005-03-25 12:31:53 -06006043 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6044 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6045 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6046 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006047
James Ketrenos43f66a62005-03-25 12:31:53 -06006048 fr.tx_rates |= mask;
6049 break;
6050 }
6051
6052 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006053 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006054}
6055
James Ketrenosea2b26e2005-08-24 21:25:16 -05006056static void ipw_abort_scan(struct ipw_priv *priv)
6057{
6058 int err;
6059
6060 if (priv->status & STATUS_SCAN_ABORTING) {
6061 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6062 return;
6063 }
6064 priv->status |= STATUS_SCAN_ABORTING;
6065
6066 err = ipw_send_scan_abort(priv);
6067 if (err)
6068 IPW_DEBUG_HC("Request to abort scan failed.\n");
6069}
6070
James Ketrenosafbf30a2005-08-25 00:05:33 -05006071static void ipw_add_scan_channels(struct ipw_priv *priv,
6072 struct ipw_scan_request_ext *scan,
6073 int scan_type)
6074{
6075 int channel_index = 0;
6076 const struct ieee80211_geo *geo;
6077 int i;
6078
Larry Finger1867b112006-02-28 09:48:28 -06006079 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006080
6081 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6082 int start = channel_index;
6083 for (i = 0; i < geo->a_channels; i++) {
6084 if ((priv->status & STATUS_ASSOCIATED) &&
6085 geo->a[i].channel == priv->channel)
6086 continue;
6087 channel_index++;
6088 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006089 ipw_set_scan_type(scan, channel_index,
6090 geo->a[i].
6091 flags & IEEE80211_CH_PASSIVE_ONLY ?
6092 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6093 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006094 }
6095
6096 if (start != channel_index) {
6097 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6098 (channel_index - start);
6099 channel_index++;
6100 }
6101 }
6102
6103 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6104 int start = channel_index;
6105 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006106 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006107 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6108 /* nop out the list */
6109 [0] = 0
6110 };
6111
6112 u8 channel;
6113 while (channel_index < IPW_SCAN_CHANNELS) {
6114 channel =
6115 priv->speed_scan[priv->speed_scan_pos];
6116 if (channel == 0) {
6117 priv->speed_scan_pos = 0;
6118 channel = priv->speed_scan[0];
6119 }
6120 if ((priv->status & STATUS_ASSOCIATED) &&
6121 channel == priv->channel) {
6122 priv->speed_scan_pos++;
6123 continue;
6124 }
6125
6126 /* If this channel has already been
6127 * added in scan, break from loop
6128 * and this will be the first channel
6129 * in the next scan.
6130 */
6131 if (channels[channel - 1] != 0)
6132 break;
6133
6134 channels[channel - 1] = 1;
6135 priv->speed_scan_pos++;
6136 channel_index++;
6137 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006138 index =
Larry Finger1867b112006-02-28 09:48:28 -06006139 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006140 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006141 geo->bg[index].
6142 flags &
6143 IEEE80211_CH_PASSIVE_ONLY ?
6144 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6145 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006146 }
6147 } else {
6148 for (i = 0; i < geo->bg_channels; i++) {
6149 if ((priv->status & STATUS_ASSOCIATED) &&
6150 geo->bg[i].channel == priv->channel)
6151 continue;
6152 channel_index++;
6153 scan->channels_list[channel_index] =
6154 geo->bg[i].channel;
6155 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006156 geo->bg[i].
6157 flags &
6158 IEEE80211_CH_PASSIVE_ONLY ?
6159 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6160 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006161 }
6162 }
6163
6164 if (start != channel_index) {
6165 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6166 (channel_index - start);
6167 }
6168 }
6169}
6170
James Ketrenosea2b26e2005-08-24 21:25:16 -05006171static int ipw_request_scan(struct ipw_priv *priv)
6172{
6173 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006174 int err = 0, scan_type;
6175
6176 if (!(priv->status & STATUS_INIT) ||
6177 (priv->status & STATUS_EXIT_PENDING))
6178 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006179
Zhu Yi46441512006-01-24 16:37:59 +08006180 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006181
James Ketrenosea2b26e2005-08-24 21:25:16 -05006182 if (priv->status & STATUS_SCANNING) {
James Ketrenosa613bff2005-08-24 21:43:11 -05006183 IPW_DEBUG_HC("Concurrent scan requested. Ignoring.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05006184 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006185 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006186 }
6187
James Ketrenosafbf30a2005-08-25 00:05:33 -05006188 if (!(priv->status & STATUS_SCAN_FORCED) &&
6189 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006190 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
6191 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006192 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006193 }
6194
6195 if (priv->status & STATUS_RF_KILL_MASK) {
6196 IPW_DEBUG_HC("Aborting scan due to RF Kill activation\n");
6197 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006198 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006199 }
6200
6201 memset(&scan, 0, sizeof(scan));
6202
James Ketrenosb095c382005-08-24 22:04:42 -05006203 if (priv->config & CFG_SPEED_SCAN)
6204 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
6205 cpu_to_le16(30);
6206 else
6207 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
6208 cpu_to_le16(20);
6209
James Ketrenosa613bff2005-08-24 21:43:11 -05006210 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
6211 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05006212 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006213
James Ketrenosa613bff2005-08-24 21:43:11 -05006214 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006215
James Ketrenosb095c382005-08-24 22:04:42 -05006216#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006217 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006218 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006219 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006220
Larry Finger1867b112006-02-28 09:48:28 -06006221 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006222 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006223 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006224 channel = priv->channel;
6225 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006226
James Ketrenosb095c382005-08-24 22:04:42 -05006227 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006228 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006229 channel = priv->channel;
6230 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006231
James Ketrenosb095c382005-08-24 22:04:42 -05006232 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006233 band = (u8) (IPW_B_MODE << 6) | 1;
6234 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006235 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006236 }
6237
James Ketrenosb095c382005-08-24 22:04:42 -05006238 scan.channels_list[0] = band;
6239 scan.channels_list[1] = channel;
6240 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006241
James Ketrenosb095c382005-08-24 22:04:42 -05006242 /* NOTE: The card will sit on this channel for this time
6243 * period. Scan aborts are timing sensitive and frequently
6244 * result in firmware restarts. As such, it is best to
6245 * set a small dwell_time here and just keep re-issuing
6246 * scans. Otherwise fast channel hopping will not actually
6247 * hop channels.
6248 *
6249 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006250 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6251 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006252 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006253#endif /* CONFIG_IPW2200_MONITOR */
6254 /* If we are roaming, then make this a directed scan for the
6255 * current network. Otherwise, ensure that every other scan
6256 * is a fast channel hop scan */
6257 if ((priv->status & STATUS_ROAMING)
6258 || (!(priv->status & STATUS_ASSOCIATED)
6259 && (priv->config & CFG_STATIC_ESSID)
6260 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006261 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6262 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006263 IPW_DEBUG_HC("Attempt to send SSID command "
6264 "failed.\n");
6265 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006266 }
6267
6268 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006269 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006270 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006271
James Ketrenosafbf30a2005-08-25 00:05:33 -05006272 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006273#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006274 }
6275#endif
6276
6277 err = ipw_send_scan_request_ext(priv, &scan);
6278 if (err) {
6279 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006280 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006281 }
6282
6283 priv->status |= STATUS_SCANNING;
6284 priv->status &= ~STATUS_SCAN_PENDING;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006285 queue_delayed_work(priv->workqueue, &priv->scan_check,
6286 IPW_SCAN_CHECK_WATCHDOG);
James Ketrenosb095c382005-08-24 22:04:42 -05006287 done:
Zhu Yi46441512006-01-24 16:37:59 +08006288 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006289 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006290}
6291
6292static void ipw_bg_abort_scan(void *data)
6293{
6294 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08006295 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006296 ipw_abort_scan(data);
Zhu Yi46441512006-01-24 16:37:59 +08006297 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006298}
6299
James Ketrenosea2b26e2005-08-24 21:25:16 -05006300static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6301{
James Ketrenosb095c382005-08-24 22:04:42 -05006302 /* This is called when wpa_supplicant loads and closes the driver
6303 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006304 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006305 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006306}
6307
James Ketrenosea2b26e2005-08-24 21:25:16 -05006308static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6309{
6310 struct ieee80211_device *ieee = priv->ieee;
6311 struct ieee80211_security sec = {
6312 .flags = SEC_AUTH_MODE,
6313 };
6314 int ret = 0;
6315
James Ketrenosafbf30a2005-08-25 00:05:33 -05006316 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006317 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6318 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006319 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006320 sec.auth_mode = WLAN_AUTH_OPEN;
6321 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006322 } else if (value & IW_AUTH_ALG_LEAP) {
6323 sec.auth_mode = WLAN_AUTH_LEAP;
6324 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006325 } else
6326 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006327
6328 if (ieee->set_security)
6329 ieee->set_security(ieee->dev, &sec);
6330 else
6331 ret = -EOPNOTSUPP;
6332
6333 return ret;
6334}
6335
Adrian Bunka73e22b2006-01-21 01:39:42 +01006336static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6337 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006338{
6339 /* make sure WPA is enabled */
6340 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006341}
6342
6343static int ipw_set_rsn_capa(struct ipw_priv *priv,
6344 char *capabilities, int length)
6345{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006346 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6347
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006348 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006349 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006350}
6351
James Ketrenosafbf30a2005-08-25 00:05:33 -05006352/*
6353 * WE-18 support
6354 */
6355
6356/* SIOCSIWGENIE */
6357static int ipw_wx_set_genie(struct net_device *dev,
6358 struct iw_request_info *info,
6359 union iwreq_data *wrqu, char *extra)
6360{
6361 struct ipw_priv *priv = ieee80211_priv(dev);
6362 struct ieee80211_device *ieee = priv->ieee;
6363 u8 *buf;
6364 int err = 0;
6365
6366 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6367 (wrqu->data.length && extra == NULL))
6368 return -EINVAL;
6369
James Ketrenosafbf30a2005-08-25 00:05:33 -05006370 if (wrqu->data.length) {
6371 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6372 if (buf == NULL) {
6373 err = -ENOMEM;
6374 goto out;
6375 }
6376
6377 memcpy(buf, extra, wrqu->data.length);
6378 kfree(ieee->wpa_ie);
6379 ieee->wpa_ie = buf;
6380 ieee->wpa_ie_len = wrqu->data.length;
6381 } else {
6382 kfree(ieee->wpa_ie);
6383 ieee->wpa_ie = NULL;
6384 ieee->wpa_ie_len = 0;
6385 }
6386
6387 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6388 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006389 return err;
6390}
6391
6392/* SIOCGIWGENIE */
6393static int ipw_wx_get_genie(struct net_device *dev,
6394 struct iw_request_info *info,
6395 union iwreq_data *wrqu, char *extra)
6396{
6397 struct ipw_priv *priv = ieee80211_priv(dev);
6398 struct ieee80211_device *ieee = priv->ieee;
6399 int err = 0;
6400
James Ketrenosafbf30a2005-08-25 00:05:33 -05006401 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6402 wrqu->data.length = 0;
6403 goto out;
6404 }
6405
6406 if (wrqu->data.length < ieee->wpa_ie_len) {
6407 err = -E2BIG;
6408 goto out;
6409 }
6410
6411 wrqu->data.length = ieee->wpa_ie_len;
6412 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6413
6414 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006415 return err;
6416}
6417
Zhu Yi1fbfea52005-08-05 17:22:56 +08006418static int wext_cipher2level(int cipher)
6419{
6420 switch (cipher) {
6421 case IW_AUTH_CIPHER_NONE:
6422 return SEC_LEVEL_0;
6423 case IW_AUTH_CIPHER_WEP40:
6424 case IW_AUTH_CIPHER_WEP104:
6425 return SEC_LEVEL_1;
6426 case IW_AUTH_CIPHER_TKIP:
6427 return SEC_LEVEL_2;
6428 case IW_AUTH_CIPHER_CCMP:
6429 return SEC_LEVEL_3;
6430 default:
6431 return -1;
6432 }
6433}
6434
James Ketrenosafbf30a2005-08-25 00:05:33 -05006435/* SIOCSIWAUTH */
6436static int ipw_wx_set_auth(struct net_device *dev,
6437 struct iw_request_info *info,
6438 union iwreq_data *wrqu, char *extra)
6439{
6440 struct ipw_priv *priv = ieee80211_priv(dev);
6441 struct ieee80211_device *ieee = priv->ieee;
6442 struct iw_param *param = &wrqu->param;
6443 struct ieee80211_crypt_data *crypt;
6444 unsigned long flags;
6445 int ret = 0;
6446
6447 switch (param->flags & IW_AUTH_INDEX) {
6448 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006449 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006450 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006451 ipw_set_hw_decrypt_unicast(priv,
6452 wext_cipher2level(param->value));
6453 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006454 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006455 ipw_set_hw_decrypt_multicast(priv,
6456 wext_cipher2level(param->value));
6457 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006458 case IW_AUTH_KEY_MGMT:
6459 /*
6460 * ipw2200 does not use these parameters
6461 */
6462 break;
6463
6464 case IW_AUTH_TKIP_COUNTERMEASURES:
6465 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006466 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006467 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006468
6469 flags = crypt->ops->get_flags(crypt->priv);
6470
6471 if (param->value)
6472 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6473 else
6474 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6475
6476 crypt->ops->set_flags(flags, crypt->priv);
6477
6478 break;
6479
6480 case IW_AUTH_DROP_UNENCRYPTED:{
6481 /* HACK:
6482 *
6483 * wpa_supplicant calls set_wpa_enabled when the driver
6484 * is loaded and unloaded, regardless of if WPA is being
6485 * used. No other calls are made which can be used to
6486 * determine if encryption will be used or not prior to
6487 * association being expected. If encryption is not being
6488 * used, drop_unencrypted is set to false, else true -- we
6489 * can use this to determine if the CAP_PRIVACY_ON bit should
6490 * be set.
6491 */
6492 struct ieee80211_security sec = {
6493 .flags = SEC_ENABLED,
6494 .enabled = param->value,
6495 };
6496 priv->ieee->drop_unencrypted = param->value;
6497 /* We only change SEC_LEVEL for open mode. Others
6498 * are set by ipw_wpa_set_encryption.
6499 */
6500 if (!param->value) {
6501 sec.flags |= SEC_LEVEL;
6502 sec.level = SEC_LEVEL_0;
6503 } else {
6504 sec.flags |= SEC_LEVEL;
6505 sec.level = SEC_LEVEL_1;
6506 }
6507 if (priv->ieee->set_security)
6508 priv->ieee->set_security(priv->ieee->dev, &sec);
6509 break;
6510 }
6511
6512 case IW_AUTH_80211_AUTH_ALG:
6513 ret = ipw_wpa_set_auth_algs(priv, param->value);
6514 break;
6515
6516 case IW_AUTH_WPA_ENABLED:
6517 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006518 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006519 break;
6520
6521 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6522 ieee->ieee802_1x = param->value;
6523 break;
6524
James Ketrenosafbf30a2005-08-25 00:05:33 -05006525 case IW_AUTH_PRIVACY_INVOKED:
6526 ieee->privacy_invoked = param->value;
6527 break;
6528
6529 default:
6530 return -EOPNOTSUPP;
6531 }
6532 return ret;
6533}
6534
6535/* SIOCGIWAUTH */
6536static int ipw_wx_get_auth(struct net_device *dev,
6537 struct iw_request_info *info,
6538 union iwreq_data *wrqu, char *extra)
6539{
6540 struct ipw_priv *priv = ieee80211_priv(dev);
6541 struct ieee80211_device *ieee = priv->ieee;
6542 struct ieee80211_crypt_data *crypt;
6543 struct iw_param *param = &wrqu->param;
6544 int ret = 0;
6545
6546 switch (param->flags & IW_AUTH_INDEX) {
6547 case IW_AUTH_WPA_VERSION:
6548 case IW_AUTH_CIPHER_PAIRWISE:
6549 case IW_AUTH_CIPHER_GROUP:
6550 case IW_AUTH_KEY_MGMT:
6551 /*
6552 * wpa_supplicant will control these internally
6553 */
6554 ret = -EOPNOTSUPP;
6555 break;
6556
6557 case IW_AUTH_TKIP_COUNTERMEASURES:
6558 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006559 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006560 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006561
6562 param->value = (crypt->ops->get_flags(crypt->priv) &
6563 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6564
6565 break;
6566
6567 case IW_AUTH_DROP_UNENCRYPTED:
6568 param->value = ieee->drop_unencrypted;
6569 break;
6570
6571 case IW_AUTH_80211_AUTH_ALG:
6572 param->value = ieee->sec.auth_mode;
6573 break;
6574
6575 case IW_AUTH_WPA_ENABLED:
6576 param->value = ieee->wpa_enabled;
6577 break;
6578
6579 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6580 param->value = ieee->ieee802_1x;
6581 break;
6582
6583 case IW_AUTH_ROAMING_CONTROL:
6584 case IW_AUTH_PRIVACY_INVOKED:
6585 param->value = ieee->privacy_invoked;
6586 break;
6587
6588 default:
6589 return -EOPNOTSUPP;
6590 }
6591 return 0;
6592}
6593
6594/* SIOCSIWENCODEEXT */
6595static int ipw_wx_set_encodeext(struct net_device *dev,
6596 struct iw_request_info *info,
6597 union iwreq_data *wrqu, char *extra)
6598{
6599 struct ipw_priv *priv = ieee80211_priv(dev);
6600 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6601
6602 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006603 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006604 /* IPW HW can't build TKIP MIC,
6605 host decryption still needed */
6606 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6607 priv->ieee->host_mc_decrypt = 1;
6608 else {
6609 priv->ieee->host_encrypt = 0;
6610 priv->ieee->host_encrypt_msdu = 1;
6611 priv->ieee->host_decrypt = 1;
6612 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006613 } else {
6614 priv->ieee->host_encrypt = 0;
6615 priv->ieee->host_encrypt_msdu = 0;
6616 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006617 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006618 }
6619 }
6620
6621 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6622}
6623
6624/* SIOCGIWENCODEEXT */
6625static int ipw_wx_get_encodeext(struct net_device *dev,
6626 struct iw_request_info *info,
6627 union iwreq_data *wrqu, char *extra)
6628{
6629 struct ipw_priv *priv = ieee80211_priv(dev);
6630 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6631}
6632
6633/* SIOCSIWMLME */
6634static int ipw_wx_set_mlme(struct net_device *dev,
6635 struct iw_request_info *info,
6636 union iwreq_data *wrqu, char *extra)
6637{
6638 struct ipw_priv *priv = ieee80211_priv(dev);
6639 struct iw_mlme *mlme = (struct iw_mlme *)extra;
6640 u16 reason;
6641
6642 reason = cpu_to_le16(mlme->reason_code);
6643
6644 switch (mlme->cmd) {
6645 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006646 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006647 break;
6648
6649 case IW_MLME_DISASSOC:
6650 ipw_disassociate(priv);
6651 break;
6652
6653 default:
6654 return -EOPNOTSUPP;
6655 }
6656 return 0;
6657}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006658
Zhu Yie43e3c12006-04-13 17:20:45 +08006659#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006660
6661/* QoS */
6662/*
6663* get the modulation type of the current network or
6664* the card current mode
6665*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006666static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006667{
6668 u8 mode = 0;
6669
6670 if (priv->status & STATUS_ASSOCIATED) {
6671 unsigned long flags;
6672
6673 spin_lock_irqsave(&priv->ieee->lock, flags);
6674 mode = priv->assoc_network->mode;
6675 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6676 } else {
6677 mode = priv->ieee->mode;
6678 }
6679 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6680 return mode;
6681}
6682
6683/*
6684* Handle management frame beacon and probe response
6685*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006686static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6687 int active_network,
6688 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006689{
6690 u32 size = sizeof(struct ieee80211_qos_parameters);
6691
James Ketrenosafbf30a2005-08-25 00:05:33 -05006692 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006693 network->qos_data.active = network->qos_data.supported;
6694
6695 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006696 if (active_network &&
6697 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006698 network->qos_data.active = network->qos_data.supported;
6699
6700 if ((network->qos_data.active == 1) && (active_network == 1) &&
6701 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6702 (network->qos_data.old_param_count !=
6703 network->qos_data.param_count)) {
6704 network->qos_data.old_param_count =
6705 network->qos_data.param_count;
6706 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006707 IPW_DEBUG_QOS("QoS parameters change call "
6708 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006709 }
6710 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006711 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6712 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006713 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006714 else
6715 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006716 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006717
James Ketrenosb095c382005-08-24 22:04:42 -05006718 if ((network->qos_data.active == 1) && (active_network == 1)) {
6719 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6720 schedule_work(&priv->qos_activate);
6721 }
6722
6723 network->qos_data.active = 0;
6724 network->qos_data.supported = 0;
6725 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006726 if ((priv->status & STATUS_ASSOCIATED) &&
6727 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6728 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
6729 if ((network->capability & WLAN_CAPABILITY_IBSS) &&
6730 !(network->flags & NETWORK_EMPTY_ESSID))
James Ketrenosb095c382005-08-24 22:04:42 -05006731 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006732 priv->assoc_network->ssid_len) &&
6733 !memcmp(network->ssid,
6734 priv->assoc_network->ssid,
6735 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006736 queue_work(priv->workqueue,
6737 &priv->merge_networks);
6738 }
James Ketrenosb095c382005-08-24 22:04:42 -05006739 }
6740
6741 return 0;
6742}
6743
6744/*
6745* This function set up the firmware to support QoS. It sends
6746* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6747*/
6748static int ipw_qos_activate(struct ipw_priv *priv,
6749 struct ieee80211_qos_data *qos_network_data)
6750{
6751 int err;
6752 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6753 struct ieee80211_qos_parameters *active_one = NULL;
6754 u32 size = sizeof(struct ieee80211_qos_parameters);
6755 u32 burst_duration;
6756 int i;
6757 u8 type;
6758
6759 type = ipw_qos_current_mode(priv);
6760
6761 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6762 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6763 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6764 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6765
6766 if (qos_network_data == NULL) {
6767 if (type == IEEE_B) {
6768 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6769 active_one = &def_parameters_CCK;
6770 } else
6771 active_one = &def_parameters_OFDM;
6772
James Ketrenosafbf30a2005-08-25 00:05:33 -05006773 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006774 burst_duration = ipw_qos_get_burst_duration(priv);
6775 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006776 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
6777 (u16) burst_duration;
6778 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006779 if (type == IEEE_B) {
6780 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6781 type);
6782 if (priv->qos_data.qos_enable == 0)
6783 active_one = &def_parameters_CCK;
6784 else
6785 active_one = priv->qos_data.def_qos_parm_CCK;
6786 } else {
6787 if (priv->qos_data.qos_enable == 0)
6788 active_one = &def_parameters_OFDM;
6789 else
6790 active_one = priv->qos_data.def_qos_parm_OFDM;
6791 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006792 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006793 } else {
6794 unsigned long flags;
6795 int active;
6796
6797 spin_lock_irqsave(&priv->ieee->lock, flags);
6798 active_one = &(qos_network_data->parameters);
6799 qos_network_data->old_param_count =
6800 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006801 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006802 active = qos_network_data->supported;
6803 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6804
6805 if (active == 0) {
6806 burst_duration = ipw_qos_get_burst_duration(priv);
6807 for (i = 0; i < QOS_QUEUE_NUM; i++)
6808 qos_parameters[QOS_PARAM_SET_ACTIVE].
6809 tx_op_limit[i] = (u16) burst_duration;
6810 }
6811 }
6812
6813 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05006814 err = ipw_send_qos_params_command(priv,
6815 (struct ieee80211_qos_parameters *)
6816 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05006817 if (err)
6818 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
6819
6820 return err;
6821}
6822
6823/*
6824* send IPW_CMD_WME_INFO to the firmware
6825*/
6826static int ipw_qos_set_info_element(struct ipw_priv *priv)
6827{
6828 int ret = 0;
6829 struct ieee80211_qos_information_element qos_info;
6830
6831 if (priv == NULL)
6832 return -1;
6833
6834 qos_info.elementID = QOS_ELEMENT_ID;
6835 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
6836
6837 qos_info.version = QOS_VERSION_1;
6838 qos_info.ac_info = 0;
6839
6840 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
6841 qos_info.qui_type = QOS_OUI_TYPE;
6842 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
6843
6844 ret = ipw_send_qos_info_command(priv, &qos_info);
6845 if (ret != 0) {
6846 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
6847 }
6848 return ret;
6849}
6850
6851/*
6852* Set the QoS parameter with the association request structure
6853*/
6854static int ipw_qos_association(struct ipw_priv *priv,
6855 struct ieee80211_network *network)
6856{
6857 int err = 0;
6858 struct ieee80211_qos_data *qos_data = NULL;
6859 struct ieee80211_qos_data ibss_data = {
6860 .supported = 1,
6861 .active = 1,
6862 };
6863
6864 switch (priv->ieee->iw_mode) {
6865 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02006866 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05006867
6868 qos_data = &ibss_data;
6869 break;
6870
6871 case IW_MODE_INFRA:
6872 qos_data = &network->qos_data;
6873 break;
6874
6875 default:
6876 BUG();
6877 break;
6878 }
6879
6880 err = ipw_qos_activate(priv, qos_data);
6881 if (err) {
6882 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
6883 return err;
6884 }
6885
6886 if (priv->qos_data.qos_enable && qos_data->supported) {
6887 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
6888 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
6889 return ipw_qos_set_info_element(priv);
6890 }
6891
6892 return 0;
6893}
6894
6895/*
6896* handling the beaconing responces. if we get different QoS setting
6897* of the network from the the associated setting adjust the QoS
6898* setting
6899*/
6900static int ipw_qos_association_resp(struct ipw_priv *priv,
6901 struct ieee80211_network *network)
6902{
6903 int ret = 0;
6904 unsigned long flags;
6905 u32 size = sizeof(struct ieee80211_qos_parameters);
6906 int set_qos_param = 0;
6907
James Ketrenosafbf30a2005-08-25 00:05:33 -05006908 if ((priv == NULL) || (network == NULL) ||
6909 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05006910 return ret;
6911
6912 if (!(priv->status & STATUS_ASSOCIATED))
6913 return ret;
6914
James Ketrenosafbf30a2005-08-25 00:05:33 -05006915 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05006916 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05006917
6918 spin_lock_irqsave(&priv->ieee->lock, flags);
6919 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006920 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05006921 sizeof(struct ieee80211_qos_data));
6922 priv->assoc_network->qos_data.active = 1;
6923 if ((network->qos_data.old_param_count !=
6924 network->qos_data.param_count)) {
6925 set_qos_param = 1;
6926 network->qos_data.old_param_count =
6927 network->qos_data.param_count;
6928 }
6929
6930 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006931 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
6932 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006933 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006934 else
6935 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006936 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006937 priv->assoc_network->qos_data.active = 0;
6938 priv->assoc_network->qos_data.supported = 0;
6939 set_qos_param = 1;
6940 }
6941
6942 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6943
6944 if (set_qos_param == 1)
6945 schedule_work(&priv->qos_activate);
6946
6947 return ret;
6948}
6949
6950static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
6951{
6952 u32 ret = 0;
6953
6954 if ((priv == NULL))
6955 return 0;
6956
James Ketrenosafbf30a2005-08-25 00:05:33 -05006957 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05006958 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006959 else
James Ketrenosb095c382005-08-24 22:04:42 -05006960 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006961
James Ketrenosb095c382005-08-24 22:04:42 -05006962 return ret;
6963}
6964
6965/*
6966* Initialize the setting of QoS global
6967*/
6968static void ipw_qos_init(struct ipw_priv *priv, int enable,
6969 int burst_enable, u32 burst_duration_CCK,
6970 u32 burst_duration_OFDM)
6971{
6972 priv->qos_data.qos_enable = enable;
6973
6974 if (priv->qos_data.qos_enable) {
6975 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
6976 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
6977 IPW_DEBUG_QOS("QoS is enabled\n");
6978 } else {
6979 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
6980 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
6981 IPW_DEBUG_QOS("QoS is not enabled\n");
6982 }
6983
6984 priv->qos_data.burst_enable = burst_enable;
6985
6986 if (burst_enable) {
6987 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
6988 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
6989 } else {
6990 priv->qos_data.burst_duration_CCK = 0;
6991 priv->qos_data.burst_duration_OFDM = 0;
6992 }
6993}
6994
6995/*
6996* map the packet priority to the right TX Queue
6997*/
6998static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
6999{
7000 if (priority > 7 || !priv->qos_data.qos_enable)
7001 priority = 0;
7002
7003 return from_priority_to_tx_queue[priority] - 1;
7004}
7005
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007006static int ipw_is_qos_active(struct net_device *dev,
7007 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007008{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007009 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007010 struct ieee80211_qos_data *qos_data = NULL;
7011 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007012 u8 *daddr = skb->data + ETH_ALEN;
7013 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007014
7015 if (!(priv->status & STATUS_ASSOCIATED))
7016 return 0;
7017
7018 qos_data = &priv->assoc_network->qos_data;
7019
James Ketrenosb095c382005-08-24 22:04:42 -05007020 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7021 if (unicast == 0)
7022 qos_data->active = 0;
7023 else
7024 qos_data->active = qos_data->supported;
7025 }
James Ketrenosb095c382005-08-24 22:04:42 -05007026 active = qos_data->active;
7027 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007028 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7029 "unicast %d\n",
7030 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007031 if (active && priv->qos_data.qos_enable)
7032 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007033
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007034 return 0;
7035
7036}
7037/*
7038* add QoS parameter to the TX command
7039*/
7040static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7041 u16 priority,
7042 struct tfd_data *tfd)
7043{
7044 int tx_queue_id = 0;
7045
7046
7047 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7048 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7049
7050 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7051 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
7052 tfd->tfd.tfd_26.mchdr.qos_ctrl |= CTRL_QOS_NO_ACK;
James Ketrenosb095c382005-08-24 22:04:42 -05007053 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007054 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007055}
7056
7057/*
7058* background support to run QoS activate functionality
7059*/
7060static void ipw_bg_qos_activate(void *data)
7061{
7062 struct ipw_priv *priv = data;
7063
7064 if (priv == NULL)
7065 return;
7066
Zhu Yi46441512006-01-24 16:37:59 +08007067 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007068
7069 if (priv->status & STATUS_ASSOCIATED)
7070 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7071
Zhu Yi46441512006-01-24 16:37:59 +08007072 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007073}
7074
James Ketrenos3b9990c2005-08-19 13:18:55 -05007075static int ipw_handle_probe_response(struct net_device *dev,
7076 struct ieee80211_probe_response *resp,
7077 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007078{
7079 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007080 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7081 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007082
James Ketrenos3b9990c2005-08-19 13:18:55 -05007083 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007084
James Ketrenos3b9990c2005-08-19 13:18:55 -05007085 return 0;
7086}
James Ketrenosb095c382005-08-24 22:04:42 -05007087
James Ketrenos3b9990c2005-08-19 13:18:55 -05007088static int ipw_handle_beacon(struct net_device *dev,
7089 struct ieee80211_beacon *resp,
7090 struct ieee80211_network *network)
7091{
7092 struct ipw_priv *priv = ieee80211_priv(dev);
7093 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7094 (network == priv->assoc_network));
7095
7096 ipw_qos_handle_probe_response(priv, active_network, network);
7097
7098 return 0;
7099}
7100
7101static int ipw_handle_assoc_response(struct net_device *dev,
7102 struct ieee80211_assoc_response *resp,
7103 struct ieee80211_network *network)
7104{
7105 struct ipw_priv *priv = ieee80211_priv(dev);
7106 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007107 return 0;
7108}
7109
7110static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7111 *qos_param)
7112{
Zhu Yi4e226992006-01-24 16:37:36 +08007113 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7114 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007115}
7116
7117static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7118 *qos_param)
7119{
Zhu Yi4e226992006-01-24 16:37:36 +08007120 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7121 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007122}
7123
Zhu Yie43e3c12006-04-13 17:20:45 +08007124#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007125
James Ketrenos43f66a62005-03-25 12:31:53 -06007126static int ipw_associate_network(struct ipw_priv *priv,
7127 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007128 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007129{
7130 int err;
7131
7132 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007133 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007134
7135 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007136 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007137 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007138 memcpy(priv->essid, network->ssid, priv->essid_len);
7139 }
7140
7141 network->last_associate = jiffies;
7142
7143 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7144 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007145 priv->assoc_request.auth_key = 0;
7146
James Ketrenos43f66a62005-03-25 12:31:53 -06007147 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007148 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007149 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007150 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7151
Zhu Yi1ba61e02006-02-15 13:00:55 +08007152 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007153 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007154
7155 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7156 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7157 priv->assoc_request.auth_type = AUTH_LEAP;
7158 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007159 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007160
James Ketrenosa613bff2005-08-24 21:43:11 -05007161 if (priv->ieee->wpa_ie_len) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05007162 priv->assoc_request.policy_support = 0x02; /* RSN active */
7163 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7164 priv->ieee->wpa_ie_len);
7165 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007166
Jeff Garzikbf794512005-07-31 13:07:26 -04007167 /*
7168 * It is valid for our ieee device to support multiple modes, but
7169 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007170 * just one mode.
7171 */
7172 if (network->mode & priv->ieee->mode & IEEE_A)
7173 priv->assoc_request.ieee_mode = IPW_A_MODE;
7174 else if (network->mode & priv->ieee->mode & IEEE_G)
7175 priv->assoc_request.ieee_mode = IPW_G_MODE;
7176 else if (network->mode & priv->ieee->mode & IEEE_B)
7177 priv->assoc_request.ieee_mode = IPW_B_MODE;
7178
James Ketrenosea2b26e2005-08-24 21:25:16 -05007179 priv->assoc_request.capability = network->capability;
7180 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7181 && !(priv->config & CFG_PREAMBLE_LONG)) {
7182 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7183 } else {
7184 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7185
7186 /* Clear the short preamble if we won't be supporting it */
7187 priv->assoc_request.capability &=
7188 ~WLAN_CAPABILITY_SHORT_PREAMBLE;
7189 }
7190
James Ketrenosafbf30a2005-08-25 00:05:33 -05007191 /* Clear capability bits that aren't used in Ad Hoc */
7192 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7193 priv->assoc_request.capability &=
7194 ~WLAN_CAPABILITY_SHORT_SLOT_TIME;
7195
James Ketrenos43f66a62005-03-25 12:31:53 -06007196 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007197 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007198 roaming ? "Rea" : "A",
Jeff Garzikbf794512005-07-31 13:07:26 -04007199 escape_essid(priv->essid, priv->essid_len),
7200 network->channel,
7201 ipw_modes[priv->assoc_request.ieee_mode],
7202 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007203 (priv->assoc_request.preamble_length ==
7204 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7205 network->capability &
7206 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007207 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007208 priv->capability & CAP_PRIVACY_ON ?
7209 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007210 "(open)") : "",
7211 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007212 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007213 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007214 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007215
7216 priv->assoc_request.beacon_interval = network->beacon_interval;
7217 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007218 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007219 priv->assoc_request.assoc_type = HC_IBSS_START;
7220 priv->assoc_request.assoc_tsf_msw = 0;
7221 priv->assoc_request.assoc_tsf_lsw = 0;
7222 } else {
7223 if (unlikely(roaming))
7224 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7225 else
7226 priv->assoc_request.assoc_type = HC_ASSOCIATE;
7227 priv->assoc_request.assoc_tsf_msw = network->time_stamp[1];
7228 priv->assoc_request.assoc_tsf_lsw = network->time_stamp[0];
7229 }
7230
James Ketrenosafbf30a2005-08-25 00:05:33 -05007231 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007232
7233 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7234 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
7235 priv->assoc_request.atim_window = network->atim_window;
7236 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007237 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007238 priv->assoc_request.atim_window = 0;
7239 }
7240
James Ketrenos43f66a62005-03-25 12:31:53 -06007241 priv->assoc_request.listen_interval = network->listen_interval;
Jeff Garzikbf794512005-07-31 13:07:26 -04007242
James Ketrenos43f66a62005-03-25 12:31:53 -06007243 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7244 if (err) {
7245 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7246 return err;
7247 }
7248
7249 rates->ieee_mode = priv->assoc_request.ieee_mode;
7250 rates->purpose = IPW_RATE_CONNECT;
7251 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007252
James Ketrenos43f66a62005-03-25 12:31:53 -06007253 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7254 priv->sys_config.dot11g_auto_detection = 1;
7255 else
7256 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007257
7258 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7259 priv->sys_config.answer_broadcast_ssid_probe = 1;
7260 else
7261 priv->sys_config.answer_broadcast_ssid_probe = 0;
7262
Zhu Yid685b8c2006-04-13 17:20:27 +08007263 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007264 if (err) {
7265 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7266 return err;
7267 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007268
James Ketrenos43f66a62005-03-25 12:31:53 -06007269 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007270 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007271 if (err) {
7272 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7273 return err;
7274 }
7275
7276 /*
7277 * If preemption is enabled, it is possible for the association
7278 * to complete before we return from ipw_send_associate. Therefore
7279 * we have to be sure and update our priviate data first.
7280 */
7281 priv->channel = network->channel;
7282 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007283 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007284 priv->status &= ~STATUS_SECURITY_UPDATED;
7285
7286 priv->assoc_network = network;
7287
Zhu Yie43e3c12006-04-13 17:20:45 +08007288#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007289 ipw_qos_association(priv, network);
7290#endif
7291
James Ketrenos43f66a62005-03-25 12:31:53 -06007292 err = ipw_send_associate(priv, &priv->assoc_request);
7293 if (err) {
7294 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7295 return err;
7296 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007297
7298 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' " MAC_FMT " \n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007299 escape_essid(priv->essid, priv->essid_len),
7300 MAC_ARG(priv->bssid));
7301
7302 return 0;
7303}
7304
7305static void ipw_roam(void *data)
7306{
7307 struct ipw_priv *priv = data;
7308 struct ieee80211_network *network = NULL;
7309 struct ipw_network_match match = {
7310 .network = priv->assoc_network
7311 };
7312
7313 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007314 *
7315 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007316 * setting the status ROAM bit and requesting a scan.
7317 * 2. When the scan completes, it schedules the ROAM work
7318 * 3. The ROAM work looks at all of the known networks for one that
7319 * is a better network than the currently associated. If none
7320 * found, the ROAM process is over (ROAM bit cleared)
7321 * 4. If a better network is found, a disassociation request is
7322 * sent.
7323 * 5. When the disassociation completes, the roam work is again
7324 * scheduled. The second time through, the driver is no longer
7325 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007326 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007327 * 6. At this point ,the roaming process is complete and the ROAM
7328 * status bit is cleared.
7329 */
7330
7331 /* If we are no longer associated, and the roaming bit is no longer
7332 * set, then we are not actively roaming, so just return */
7333 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7334 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007335
James Ketrenos43f66a62005-03-25 12:31:53 -06007336 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007337 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007338 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007339 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007340 u8 rssi = priv->assoc_network->stats.rssi;
7341 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007342 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007343 list_for_each_entry(network, &priv->ieee->network_list, list) {
7344 if (network != priv->assoc_network)
7345 ipw_best_network(priv, &match, network, 1);
7346 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007347 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007348 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007349
James Ketrenos43f66a62005-03-25 12:31:53 -06007350 if (match.network == priv->assoc_network) {
7351 IPW_DEBUG_ASSOC("No better APs in this network to "
7352 "roam to.\n");
7353 priv->status &= ~STATUS_ROAMING;
7354 ipw_debug_config(priv);
7355 return;
7356 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007357
James Ketrenos43f66a62005-03-25 12:31:53 -06007358 ipw_send_disassociate(priv, 1);
7359 priv->assoc_network = match.network;
7360
7361 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007362 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007363
7364 /* Second pass through ROAM process -- request association */
7365 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7366 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7367 priv->status &= ~STATUS_ROAMING;
7368}
7369
James Ketrenosc848d0a2005-08-24 21:56:24 -05007370static void ipw_bg_roam(void *data)
7371{
7372 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08007373 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007374 ipw_roam(data);
Zhu Yi46441512006-01-24 16:37:59 +08007375 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007376}
7377
7378static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007379{
7380 struct ipw_priv *priv = data;
7381
7382 struct ieee80211_network *network = NULL;
7383 struct ipw_network_match match = {
7384 .network = NULL
7385 };
7386 struct ipw_supported_rates *rates;
7387 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007388 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007389
James Ketrenosb095c382005-08-24 22:04:42 -05007390 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7391 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7392 return 0;
7393 }
7394
James Ketrenosc848d0a2005-08-24 21:56:24 -05007395 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007396 IPW_DEBUG_ASSOC("Not attempting association (already in "
7397 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007398 return 0;
7399 }
7400
Hong Liue6324722005-09-14 21:04:15 -05007401 if (priv->status & STATUS_DISASSOCIATING) {
7402 IPW_DEBUG_ASSOC("Not attempting association (in "
7403 "disassociating)\n ");
7404 queue_work(priv->workqueue, &priv->associate);
7405 return 0;
7406 }
7407
James Ketrenosc848d0a2005-08-24 21:56:24 -05007408 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007409 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7410 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007411 return 0;
7412 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007413
7414 if (!(priv->config & CFG_ASSOCIATE) &&
7415 !(priv->config & (CFG_STATIC_ESSID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007416 CFG_STATIC_CHANNEL | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007417 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007418 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007419 }
7420
James Ketrenosa613bff2005-08-24 21:43:11 -05007421 /* Protect our use of the network_list */
7422 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007423 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007424 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007425
7426 network = match.network;
7427 rates = &match.rates;
7428
7429 if (network == NULL &&
7430 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7431 priv->config & CFG_ADHOC_CREATE &&
7432 priv->config & CFG_STATIC_ESSID &&
James Ketrenosa613bff2005-08-24 21:43:11 -05007433 priv->config & CFG_STATIC_CHANNEL &&
James Ketrenos43f66a62005-03-25 12:31:53 -06007434 !list_empty(&priv->ieee->network_free_list)) {
7435 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007436 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007437 ipw_adhoc_create(priv, network);
7438 rates = &priv->rates;
7439 list_del(element);
7440 list_add_tail(&network->list, &priv->ieee->network_list);
7441 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007442 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007443
James Ketrenos43f66a62005-03-25 12:31:53 -06007444 /* If we reached the end of the list, then we don't have any valid
7445 * matching APs */
7446 if (!network) {
7447 ipw_debug_config(priv);
7448
James Ketrenosb095c382005-08-24 22:04:42 -05007449 if (!(priv->status & STATUS_SCANNING)) {
7450 if (!(priv->config & CFG_SPEED_SCAN))
7451 queue_delayed_work(priv->workqueue,
7452 &priv->request_scan,
7453 SCAN_INTERVAL);
7454 else
7455 queue_work(priv->workqueue,
7456 &priv->request_scan);
7457 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007458
James Ketrenosc848d0a2005-08-24 21:56:24 -05007459 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007460 }
7461
7462 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007463
7464 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007465}
Jeff Garzikbf794512005-07-31 13:07:26 -04007466
James Ketrenosc848d0a2005-08-24 21:56:24 -05007467static void ipw_bg_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007468{
James Ketrenosc848d0a2005-08-24 21:56:24 -05007469 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08007470 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007471 ipw_associate(data);
Zhu Yi46441512006-01-24 16:37:59 +08007472 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007473}
7474
James Ketrenosb095c382005-08-24 22:04:42 -05007475static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7476 struct sk_buff *skb)
7477{
7478 struct ieee80211_hdr *hdr;
7479 u16 fc;
7480
7481 hdr = (struct ieee80211_hdr *)skb->data;
7482 fc = le16_to_cpu(hdr->frame_ctl);
7483 if (!(fc & IEEE80211_FCTL_PROTECTED))
7484 return;
7485
7486 fc &= ~IEEE80211_FCTL_PROTECTED;
7487 hdr->frame_ctl = cpu_to_le16(fc);
7488 switch (priv->ieee->sec.level) {
7489 case SEC_LEVEL_3:
7490 /* Remove CCMP HDR */
7491 memmove(skb->data + IEEE80211_3ADDR_LEN,
7492 skb->data + IEEE80211_3ADDR_LEN + 8,
7493 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007494 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007495 break;
7496 case SEC_LEVEL_2:
7497 break;
7498 case SEC_LEVEL_1:
7499 /* Remove IV */
7500 memmove(skb->data + IEEE80211_3ADDR_LEN,
7501 skb->data + IEEE80211_3ADDR_LEN + 4,
7502 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007503 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007504 break;
7505 case SEC_LEVEL_0:
7506 break;
7507 default:
7508 printk(KERN_ERR "Unknow security level %d\n",
7509 priv->ieee->sec.level);
7510 break;
7511 }
7512}
7513
7514static void ipw_handle_data_packet(struct ipw_priv *priv,
7515 struct ipw_rx_mem_buffer *rxb,
7516 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007517{
Hong Liu567deaf2005-08-31 18:07:22 +08007518 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007519 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7520
7521 /* We received data from the HW, so stop the watchdog */
7522 priv->net_dev->trans_start = jiffies;
7523
Jeff Garzikbf794512005-07-31 13:07:26 -04007524 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007525 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007526 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007527 skb_tailroom(rxb->skb))) {
7528 priv->ieee->stats.rx_errors++;
7529 priv->wstats.discard.misc++;
7530 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7531 return;
7532 } else if (unlikely(!netif_running(priv->net_dev))) {
7533 priv->ieee->stats.rx_dropped++;
7534 priv->wstats.discard.misc++;
7535 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7536 return;
7537 }
7538
7539 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007540 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007541
7542 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007543 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007544
7545 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7546
James Ketrenosb095c382005-08-24 22:04:42 -05007547 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007548 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7549 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007550 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007551 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007552 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7553
Jeff Garzikbf794512005-07-31 13:07:26 -04007554 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
James Ketrenos43f66a62005-03-25 12:31:53 -06007555 priv->ieee->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007556 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007557 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007558 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007559 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007560}
7561
Zhu Yi459d4082006-04-13 17:21:00 +08007562#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007563static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7564 struct ipw_rx_mem_buffer *rxb,
7565 struct ieee80211_rx_stats *stats)
7566{
7567 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7568 struct ipw_rx_frame *frame = &pkt->u.frame;
7569
7570 /* initial pull of some data */
7571 u16 received_channel = frame->received_channel;
7572 u8 antennaAndPhy = frame->antennaAndPhy;
7573 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7574 u16 pktrate = frame->rate;
7575
7576 /* Magic struct that slots into the radiotap header -- no reason
7577 * to build this manually element by element, we can write it much
7578 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007579 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007580
7581 short len = le16_to_cpu(pkt->u.frame.length);
7582
7583 /* We received data from the HW, so stop the watchdog */
7584 priv->net_dev->trans_start = jiffies;
7585
7586 /* We only process data packets if the
7587 * interface is open */
7588 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7589 skb_tailroom(rxb->skb))) {
7590 priv->ieee->stats.rx_errors++;
7591 priv->wstats.discard.misc++;
7592 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7593 return;
7594 } else if (unlikely(!netif_running(priv->net_dev))) {
7595 priv->ieee->stats.rx_dropped++;
7596 priv->wstats.discard.misc++;
7597 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7598 return;
7599 }
7600
7601 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7602 * that now */
7603 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7604 /* FIXME: Should alloc bigger skb instead */
7605 priv->ieee->stats.rx_dropped++;
7606 priv->wstats.discard.misc++;
7607 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7608 return;
7609 }
7610
7611 /* copy the frame itself */
7612 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7613 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7614
7615 /* Zero the radiotap static buffer ... We only need to zero the bytes NOT
7616 * part of our real header, saves a little time.
7617 *
7618 * No longer necessary since we fill in all our data. Purge before merging
7619 * patch officially.
7620 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7621 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7622 */
7623
7624 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7625
7626 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7627 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7628 ipw_rt->rt_hdr.it_len = sizeof(struct ipw_rt_hdr); /* total header+data */
7629
7630 /* Big bitfield of all the fields we provide in radiotap */
7631 ipw_rt->rt_hdr.it_present =
7632 ((1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007633 (1 << IEEE80211_RADIOTAP_TSFT) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007634 (1 << IEEE80211_RADIOTAP_RATE) |
7635 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7636 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007637 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007638 (1 << IEEE80211_RADIOTAP_ANTENNA));
7639
7640 /* Zero the flags, we'll add to them as we go */
7641 ipw_rt->rt_flags = 0;
7642
7643 /* Convert signal to DBM */
7644 ipw_rt->rt_dbmsignal = antsignal;
7645
7646 /* Convert the channel data and set the flags */
7647 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7648 if (received_channel > 14) { /* 802.11a */
7649 ipw_rt->rt_chbitmask =
7650 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7651 } else if (antennaAndPhy & 32) { /* 802.11b */
7652 ipw_rt->rt_chbitmask =
7653 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7654 } else { /* 802.11g */
7655 ipw_rt->rt_chbitmask =
7656 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7657 }
7658
7659 /* set the rate in multiples of 500k/s */
7660 switch (pktrate) {
7661 case IPW_TX_RATE_1MB:
7662 ipw_rt->rt_rate = 2;
7663 break;
7664 case IPW_TX_RATE_2MB:
7665 ipw_rt->rt_rate = 4;
7666 break;
7667 case IPW_TX_RATE_5MB:
7668 ipw_rt->rt_rate = 10;
7669 break;
7670 case IPW_TX_RATE_6MB:
7671 ipw_rt->rt_rate = 12;
7672 break;
7673 case IPW_TX_RATE_9MB:
7674 ipw_rt->rt_rate = 18;
7675 break;
7676 case IPW_TX_RATE_11MB:
7677 ipw_rt->rt_rate = 22;
7678 break;
7679 case IPW_TX_RATE_12MB:
7680 ipw_rt->rt_rate = 24;
7681 break;
7682 case IPW_TX_RATE_18MB:
7683 ipw_rt->rt_rate = 36;
7684 break;
7685 case IPW_TX_RATE_24MB:
7686 ipw_rt->rt_rate = 48;
7687 break;
7688 case IPW_TX_RATE_36MB:
7689 ipw_rt->rt_rate = 72;
7690 break;
7691 case IPW_TX_RATE_48MB:
7692 ipw_rt->rt_rate = 96;
7693 break;
7694 case IPW_TX_RATE_54MB:
7695 ipw_rt->rt_rate = 108;
7696 break;
7697 default:
7698 ipw_rt->rt_rate = 0;
7699 break;
7700 }
7701
7702 /* antenna number */
7703 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7704
7705 /* set the preamble flag if we have it */
7706 if ((antennaAndPhy & 64))
7707 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7708
7709 /* Set the size of the skb to the size of the frame */
7710 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007711
7712 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7713
7714 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
7715 priv->ieee->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007716 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007717 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007718 /* no LED during capture */
7719 }
7720}
7721#endif
7722
Zhu Yid685b8c2006-04-13 17:20:27 +08007723#ifdef CONFIG_IPW2200_PROMISCUOUS
7724#define ieee80211_is_probe_response(fc) \
7725 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7726 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7727
7728#define ieee80211_is_management(fc) \
7729 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7730
7731#define ieee80211_is_control(fc) \
7732 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7733
7734#define ieee80211_is_data(fc) \
7735 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7736
7737#define ieee80211_is_assoc_request(fc) \
7738 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7739
7740#define ieee80211_is_reassoc_request(fc) \
7741 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7742
7743static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7744 struct ipw_rx_mem_buffer *rxb,
7745 struct ieee80211_rx_stats *stats)
7746{
7747 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7748 struct ipw_rx_frame *frame = &pkt->u.frame;
7749 struct ipw_rt_hdr *ipw_rt;
7750
7751 /* First cache any information we need before we overwrite
7752 * the information provided in the skb from the hardware */
7753 struct ieee80211_hdr *hdr;
7754 u16 channel = frame->received_channel;
7755 u8 phy_flags = frame->antennaAndPhy;
7756 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7757 s8 noise = frame->noise;
7758 u8 rate = frame->rate;
7759 short len = le16_to_cpu(pkt->u.frame.length);
7760 u64 tsf = 0;
7761 struct sk_buff *skb;
7762 int hdr_only = 0;
7763 u16 filter = priv->prom_priv->filter;
7764
7765 /* If the filter is set to not include Rx frames then return */
7766 if (filter & IPW_PROM_NO_RX)
7767 return;
7768
Zhu Yid685b8c2006-04-13 17:20:27 +08007769 /* We received data from the HW, so stop the watchdog */
7770 priv->prom_net_dev->trans_start = jiffies;
7771
7772 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
7773 priv->prom_priv->ieee->stats.rx_errors++;
7774 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7775 return;
7776 }
7777
7778 /* We only process data packets if the interface is open */
7779 if (unlikely(!netif_running(priv->prom_net_dev))) {
7780 priv->prom_priv->ieee->stats.rx_dropped++;
7781 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7782 return;
7783 }
7784
7785 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7786 * that now */
7787 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7788 /* FIXME: Should alloc bigger skb instead */
7789 priv->prom_priv->ieee->stats.rx_dropped++;
7790 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7791 return;
7792 }
7793
7794 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
7795 if (ieee80211_is_management(hdr->frame_ctl)) {
7796 if (filter & IPW_PROM_NO_MGMT)
7797 return;
7798 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
7799 hdr_only = 1;
7800 } else if (ieee80211_is_control(hdr->frame_ctl)) {
7801 if (filter & IPW_PROM_NO_CTL)
7802 return;
7803 if (filter & IPW_PROM_CTL_HEADER_ONLY)
7804 hdr_only = 1;
7805 } else if (ieee80211_is_data(hdr->frame_ctl)) {
7806 if (filter & IPW_PROM_NO_DATA)
7807 return;
7808 if (filter & IPW_PROM_DATA_HEADER_ONLY)
7809 hdr_only = 1;
7810 }
7811
7812 /* Copy the SKB since this is for the promiscuous side */
7813 skb = skb_copy(rxb->skb, GFP_ATOMIC);
7814 if (skb == NULL) {
7815 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
7816 return;
7817 }
7818
7819 /* copy the frame data to write after where the radiotap header goes */
7820 ipw_rt = (void *)skb->data;
7821
7822 if (hdr_only)
7823 len = ieee80211_get_hdrlen(hdr->frame_ctl);
7824
7825 memcpy(ipw_rt->payload, hdr, len);
7826
7827 /* Zero the radiotap static buffer ... We only need to zero the bytes
7828 * NOT part of our real header, saves a little time.
7829 *
7830 * No longer necessary since we fill in all our data. Purge before
7831 * merging patch officially.
7832 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7833 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7834 */
7835
7836 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7837 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7838 ipw_rt->rt_hdr.it_len = sizeof(*ipw_rt); /* total header+data */
7839
7840 /* Set the size of the skb to the size of the frame */
7841 skb_put(skb, ipw_rt->rt_hdr.it_len + len);
7842
7843 /* Big bitfield of all the fields we provide in radiotap */
7844 ipw_rt->rt_hdr.it_present =
7845 ((1 << IEEE80211_RADIOTAP_FLAGS) |
7846 (1 << IEEE80211_RADIOTAP_TSFT) |
7847 (1 << IEEE80211_RADIOTAP_RATE) |
7848 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7849 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
7850 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
7851 (1 << IEEE80211_RADIOTAP_ANTENNA));
7852
7853 /* Zero the flags, we'll add to them as we go */
7854 ipw_rt->rt_flags = 0;
7855
7856 ipw_rt->rt_tsf = tsf;
7857
7858 /* Convert to DBM */
7859 ipw_rt->rt_dbmsignal = signal;
7860 ipw_rt->rt_dbmnoise = noise;
7861
7862 /* Convert the channel data and set the flags */
7863 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
7864 if (channel > 14) { /* 802.11a */
7865 ipw_rt->rt_chbitmask =
7866 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7867 } else if (phy_flags & (1 << 5)) { /* 802.11b */
7868 ipw_rt->rt_chbitmask =
7869 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7870 } else { /* 802.11g */
7871 ipw_rt->rt_chbitmask =
7872 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7873 }
7874
7875 /* set the rate in multiples of 500k/s */
7876 switch (rate) {
7877 case IPW_TX_RATE_1MB:
7878 ipw_rt->rt_rate = 2;
7879 break;
7880 case IPW_TX_RATE_2MB:
7881 ipw_rt->rt_rate = 4;
7882 break;
7883 case IPW_TX_RATE_5MB:
7884 ipw_rt->rt_rate = 10;
7885 break;
7886 case IPW_TX_RATE_6MB:
7887 ipw_rt->rt_rate = 12;
7888 break;
7889 case IPW_TX_RATE_9MB:
7890 ipw_rt->rt_rate = 18;
7891 break;
7892 case IPW_TX_RATE_11MB:
7893 ipw_rt->rt_rate = 22;
7894 break;
7895 case IPW_TX_RATE_12MB:
7896 ipw_rt->rt_rate = 24;
7897 break;
7898 case IPW_TX_RATE_18MB:
7899 ipw_rt->rt_rate = 36;
7900 break;
7901 case IPW_TX_RATE_24MB:
7902 ipw_rt->rt_rate = 48;
7903 break;
7904 case IPW_TX_RATE_36MB:
7905 ipw_rt->rt_rate = 72;
7906 break;
7907 case IPW_TX_RATE_48MB:
7908 ipw_rt->rt_rate = 96;
7909 break;
7910 case IPW_TX_RATE_54MB:
7911 ipw_rt->rt_rate = 108;
7912 break;
7913 default:
7914 ipw_rt->rt_rate = 0;
7915 break;
7916 }
7917
7918 /* antenna number */
7919 ipw_rt->rt_antenna = (phy_flags & 3);
7920
7921 /* set the preamble flag if we have it */
7922 if (phy_flags & (1 << 6))
7923 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7924
7925 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
7926
7927 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
7928 priv->prom_priv->ieee->stats.rx_errors++;
7929 dev_kfree_skb_any(skb);
7930 }
7931}
7932#endif
7933
Arjan van de Ven858119e2006-01-14 13:20:43 -08007934static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007935 struct ieee80211_hdr_4addr *header)
7936{
7937 /* Filter incoming packets to determine if they are targetted toward
7938 * this network, discarding packets coming from ourselves */
7939 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05007940 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05007941 /* packets from our adapter are dropped (echo) */
7942 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
7943 return 0;
7944
Peter Jones90700fd2005-08-26 16:51:06 -05007945 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08007946 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05007947 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05007948
7949 /* packets to our adapter go through */
7950 return !memcmp(header->addr1, priv->net_dev->dev_addr,
7951 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05007952
Peter Jones90700fd2005-08-26 16:51:06 -05007953 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05007954 /* packets from our adapter are dropped (echo) */
7955 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
7956 return 0;
7957
Peter Jones90700fd2005-08-26 16:51:06 -05007958 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08007959 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05007960 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
7961
7962 /* packets to our adapter go through */
7963 return !memcmp(header->addr1, priv->net_dev->dev_addr,
7964 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007965 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007966
James Ketrenosea2b26e2005-08-24 21:25:16 -05007967 return 1;
7968}
7969
James Ketrenosafbf30a2005-08-25 00:05:33 -05007970#define IPW_PACKET_RETRY_TIME HZ
7971
Arjan van de Ven858119e2006-01-14 13:20:43 -08007972static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05007973 struct ieee80211_hdr_4addr *header)
7974{
James Ketrenosafbf30a2005-08-25 00:05:33 -05007975 u16 sc = le16_to_cpu(header->seq_ctl);
7976 u16 seq = WLAN_GET_SEQ_SEQ(sc);
7977 u16 frag = WLAN_GET_SEQ_FRAG(sc);
7978 u16 *last_seq, *last_frag;
7979 unsigned long *last_time;
7980
7981 switch (priv->ieee->iw_mode) {
7982 case IW_MODE_ADHOC:
7983 {
7984 struct list_head *p;
7985 struct ipw_ibss_seq *entry = NULL;
7986 u8 *mac = header->addr2;
7987 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
7988
7989 __list_for_each(p, &priv->ibss_mac_hash[index]) {
7990 entry =
7991 list_entry(p, struct ipw_ibss_seq, list);
7992 if (!memcmp(entry->mac, mac, ETH_ALEN))
7993 break;
7994 }
7995 if (p == &priv->ibss_mac_hash[index]) {
7996 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
7997 if (!entry) {
7998 IPW_ERROR
7999 ("Cannot malloc new mac entry\n");
8000 return 0;
8001 }
8002 memcpy(entry->mac, mac, ETH_ALEN);
8003 entry->seq_num = seq;
8004 entry->frag_num = frag;
8005 entry->packet_time = jiffies;
8006 list_add(&entry->list,
8007 &priv->ibss_mac_hash[index]);
8008 return 0;
8009 }
8010 last_seq = &entry->seq_num;
8011 last_frag = &entry->frag_num;
8012 last_time = &entry->packet_time;
8013 break;
8014 }
8015 case IW_MODE_INFRA:
8016 last_seq = &priv->last_seq_num;
8017 last_frag = &priv->last_frag_num;
8018 last_time = &priv->last_packet_time;
8019 break;
8020 default:
8021 return 0;
8022 }
8023 if ((*last_seq == seq) &&
8024 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8025 if (*last_frag == frag)
8026 goto drop;
8027 if (*last_frag + 1 != frag)
8028 /* out-of-order fragment */
8029 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008030 } else
8031 *last_seq = seq;
8032
Zhu Yif57ce7c2005-07-13 12:22:15 -05008033 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008034 *last_time = jiffies;
8035 return 0;
8036
8037 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008038 /* Comment this line now since we observed the card receives
8039 * duplicate packets but the FCTL_RETRY bit is not set in the
8040 * IBSS mode with fragmentation enabled.
8041 BUG_ON(!(le16_to_cpu(header->frame_ctl) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008042 return 1;
8043}
8044
James Ketrenosb095c382005-08-24 22:04:42 -05008045static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8046 struct ipw_rx_mem_buffer *rxb,
8047 struct ieee80211_rx_stats *stats)
8048{
8049 struct sk_buff *skb = rxb->skb;
8050 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8051 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8052 (skb->data + IPW_RX_FRAME_SIZE);
8053
8054 ieee80211_rx_mgt(priv->ieee, header, stats);
8055
8056 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8057 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8058 IEEE80211_STYPE_PROBE_RESP) ||
8059 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8060 IEEE80211_STYPE_BEACON))) {
8061 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8062 ipw_add_station(priv, header->addr2);
8063 }
8064
8065 if (priv->config & CFG_NET_STATS) {
8066 IPW_DEBUG_HC("sending stat packet\n");
8067
8068 /* Set the size of the skb to the size of the full
8069 * ipw header and 802.11 frame */
8070 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8071 IPW_RX_FRAME_SIZE);
8072
8073 /* Advance past the ipw packet header to the 802.11 frame */
8074 skb_pull(skb, IPW_RX_FRAME_SIZE);
8075
8076 /* Push the ieee80211_rx_stats before the 802.11 frame */
8077 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8078
8079 skb->dev = priv->ieee->dev;
8080
8081 /* Point raw at the ieee80211_stats */
8082 skb->mac.raw = skb->data;
8083
8084 skb->pkt_type = PACKET_OTHERHOST;
8085 skb->protocol = __constant_htons(ETH_P_80211_STATS);
8086 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8087 netif_rx(skb);
8088 rxb->skb = NULL;
8089 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008090}
8091
James Ketrenos43f66a62005-03-25 12:31:53 -06008092/*
8093 * Main entry function for recieving a packet with 80211 headers. This
8094 * should be called when ever the FW has notified us that there is a new
8095 * skb in the recieve queue.
8096 */
8097static void ipw_rx(struct ipw_priv *priv)
8098{
8099 struct ipw_rx_mem_buffer *rxb;
8100 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008101 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008102 u32 r, w, i;
8103 u8 network_packet;
8104
James Ketrenosb095c382005-08-24 22:04:42 -05008105 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8106 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
James Ketrenos43f66a62005-03-25 12:31:53 -06008107 i = (priv->rxq->processed + 1) % RX_QUEUE_SIZE;
8108
8109 while (i != r) {
8110 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008111 if (unlikely(rxb == NULL)) {
8112 printk(KERN_CRIT "Queue not allocated!\n");
8113 break;
8114 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008115 priv->rxq->queue[i] = NULL;
8116
8117 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008118 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008119 PCI_DMA_FROMDEVICE);
8120
8121 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8122 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8123 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008124 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008125
8126 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008127 case RX_FRAME_TYPE: /* 802.11 frame */ {
8128 struct ieee80211_rx_stats stats = {
James Ketrenosc848d0a2005-08-24 21:56:24 -05008129 .rssi =
8130 le16_to_cpu(pkt->u.frame.rssi_dbm) -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008131 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008132 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008133 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8134 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008135 .noise =
8136 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008137 .rate = pkt->u.frame.rate,
8138 .mac_time = jiffies,
8139 .received_channel =
8140 pkt->u.frame.received_channel,
8141 .freq =
8142 (pkt->u.frame.
8143 control & (1 << 0)) ?
8144 IEEE80211_24GHZ_BAND :
8145 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008146 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008147 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008148
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008149 if (stats.rssi != 0)
8150 stats.mask |= IEEE80211_STATMASK_RSSI;
8151 if (stats.signal != 0)
8152 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008153 if (stats.noise != 0)
8154 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008155 if (stats.rate != 0)
8156 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008157
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008158 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008159
Zhu Yid685b8c2006-04-13 17:20:27 +08008160#ifdef CONFIG_IPW2200_PROMISCUOUS
8161 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8162 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8163#endif
8164
James Ketrenosb095c382005-08-24 22:04:42 -05008165#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008166 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008167#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008168
8169 ipw_handle_data_packet_monitor(priv,
8170 rxb,
8171 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008172#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008173 ipw_handle_data_packet(priv, rxb,
8174 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008175#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008176 break;
8177 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008178#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008179
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008180 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008181 (struct ieee80211_hdr_4addr *)(rxb->skb->
8182 data +
8183 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008184 /* TODO: Check Ad-Hoc dest/source and make sure
8185 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008186 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008187 * frame control of the packet and disregard
8188 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008189
James Ketrenosea2b26e2005-08-24 21:25:16 -05008190 network_packet =
8191 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008192 if (network_packet && priv->assoc_network) {
8193 priv->assoc_network->stats.rssi =
8194 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008195 priv->exp_avg_rssi =
8196 exponential_average(priv->exp_avg_rssi,
8197 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008198 }
8199
8200 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008201 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008202
James Ketrenosa613bff2005-08-24 21:43:11 -05008203 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008204 ieee80211_get_hdrlen(le16_to_cpu(
8205 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008206 IPW_DEBUG_DROP
8207 ("Received packet is too small. "
8208 "Dropping.\n");
8209 priv->ieee->stats.rx_errors++;
8210 priv->wstats.discard.misc++;
8211 break;
8212 }
8213
James Ketrenosa613bff2005-08-24 21:43:11 -05008214 switch (WLAN_FC_GET_TYPE
8215 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008216
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008217 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008218 ipw_handle_mgmt_packet(priv, rxb,
8219 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008220 break;
8221
8222 case IEEE80211_FTYPE_CTL:
8223 break;
8224
8225 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008226 if (unlikely(!network_packet ||
8227 is_duplicate_packet(priv,
8228 header)))
8229 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008230 IPW_DEBUG_DROP("Dropping: "
8231 MAC_FMT ", "
8232 MAC_FMT ", "
8233 MAC_FMT "\n",
8234 MAC_ARG(header->
8235 addr1),
8236 MAC_ARG(header->
8237 addr2),
8238 MAC_ARG(header->
8239 addr3));
James Ketrenosb095c382005-08-24 22:04:42 -05008240 break;
8241 }
8242
8243 ipw_handle_data_packet(priv, rxb,
8244 &stats);
8245
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008246 break;
8247 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008248 break;
8249 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008250
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008251 case RX_HOST_NOTIFICATION_TYPE:{
8252 IPW_DEBUG_RX
8253 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008254 pkt->u.notification.subtype,
8255 pkt->u.notification.flags,
8256 pkt->u.notification.size);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008257 ipw_rx_notification(priv, &pkt->u.notification);
8258 break;
8259 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008260
8261 default:
8262 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8263 pkt->header.message_type);
8264 break;
8265 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008266
8267 /* For now we just don't re-use anything. We can tweak this
8268 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008269 * fail to Rx correctly */
8270 if (rxb->skb != NULL) {
8271 dev_kfree_skb_any(rxb->skb);
8272 rxb->skb = NULL;
8273 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008274
James Ketrenos43f66a62005-03-25 12:31:53 -06008275 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008276 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008277 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008278
James Ketrenos43f66a62005-03-25 12:31:53 -06008279 i = (i + 1) % RX_QUEUE_SIZE;
8280 }
8281
8282 /* Backtrack one entry */
8283 priv->rxq->processed = (i ? i : RX_QUEUE_SIZE) - 1;
8284
8285 ipw_rx_queue_restock(priv);
8286}
8287
James Ketrenosafbf30a2005-08-25 00:05:33 -05008288#define DEFAULT_RTS_THRESHOLD 2304U
8289#define MIN_RTS_THRESHOLD 1U
8290#define MAX_RTS_THRESHOLD 2304U
8291#define DEFAULT_BEACON_INTERVAL 100U
8292#define DEFAULT_SHORT_RETRY_LIMIT 7U
8293#define DEFAULT_LONG_RETRY_LIMIT 4U
8294
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008295/**
8296 * ipw_sw_reset
8297 * @option: options to control different reset behaviour
8298 * 0 = reset everything except the 'disable' module_param
8299 * 1 = reset everything and print out driver info (for probe only)
8300 * 2 = reset everything
8301 */
8302static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008303{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008304 int band, modulation;
8305 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008306
James Ketrenosafbf30a2005-08-25 00:05:33 -05008307 /* Initialize module parameter values here */
8308 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008309
James Ketrenosafbf30a2005-08-25 00:05:33 -05008310 /* We default to disabling the LED code as right now it causes
8311 * too many systems to lock up... */
8312 if (!led)
8313 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008314
James Ketrenosafbf30a2005-08-25 00:05:33 -05008315 if (associate)
8316 priv->config |= CFG_ASSOCIATE;
8317 else
8318 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008319
James Ketrenosafbf30a2005-08-25 00:05:33 -05008320 if (auto_create)
8321 priv->config |= CFG_ADHOC_CREATE;
8322 else
8323 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8324
Zhu Yi17ed0812006-01-24 16:36:31 +08008325 priv->config &= ~CFG_STATIC_ESSID;
8326 priv->essid_len = 0;
8327 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8328
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008329 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008330 priv->status |= STATUS_RF_KILL_SW;
8331 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008332 }
8333
James Ketrenosafbf30a2005-08-25 00:05:33 -05008334 if (channel != 0) {
8335 priv->config |= CFG_STATIC_CHANNEL;
8336 priv->channel = channel;
8337 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8338 /* TODO: Validate that provided channel is in range */
8339 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008340#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008341 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8342 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008343#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008344
8345 switch (mode) {
8346 case 1:
8347 priv->ieee->iw_mode = IW_MODE_ADHOC;
8348 priv->net_dev->type = ARPHRD_ETHER;
8349
8350 break;
8351#ifdef CONFIG_IPW2200_MONITOR
8352 case 2:
8353 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008354#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008355 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8356#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008357 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008358#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008359 break;
8360#endif
8361 default:
8362 case 0:
8363 priv->net_dev->type = ARPHRD_ETHER;
8364 priv->ieee->iw_mode = IW_MODE_INFRA;
8365 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008366 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008367
James Ketrenosafbf30a2005-08-25 00:05:33 -05008368 if (hwcrypto) {
8369 priv->ieee->host_encrypt = 0;
8370 priv->ieee->host_encrypt_msdu = 0;
8371 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008372 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008373 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008374 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008375
Zhu Yie402c932005-08-05 17:20:40 +08008376 /* IPW2200/2915 is abled to do hardware fragmentation. */
8377 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008378
James Ketrenosafbf30a2005-08-25 00:05:33 -05008379 if ((priv->pci_dev->device == 0x4223) ||
8380 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008381 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008382 printk(KERN_INFO DRV_NAME
8383 ": Detected Intel PRO/Wireless 2915ABG Network "
8384 "Connection\n");
8385 priv->ieee->abg_true = 1;
8386 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8387 modulation = IEEE80211_OFDM_MODULATION |
8388 IEEE80211_CCK_MODULATION;
8389 priv->adapter = IPW_2915ABG;
8390 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008391 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008392 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008393 printk(KERN_INFO DRV_NAME
8394 ": Detected Intel PRO/Wireless 2200BG Network "
8395 "Connection\n");
8396
8397 priv->ieee->abg_true = 0;
8398 band = IEEE80211_24GHZ_BAND;
8399 modulation = IEEE80211_OFDM_MODULATION |
8400 IEEE80211_CCK_MODULATION;
8401 priv->adapter = IPW_2200BG;
8402 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008403 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008404
James Ketrenosafbf30a2005-08-25 00:05:33 -05008405 priv->ieee->freq_band = band;
8406 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008407
James Ketrenosafbf30a2005-08-25 00:05:33 -05008408 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008409
James Ketrenosafbf30a2005-08-25 00:05:33 -05008410 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8411 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008412
James Ketrenosafbf30a2005-08-25 00:05:33 -05008413 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8414 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8415 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008416
James Ketrenosafbf30a2005-08-25 00:05:33 -05008417 /* If power management is turned on, default to AC mode */
8418 priv->power_mode = IPW_POWER_AC;
8419 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008420
Zhu Yi0ece35b2005-08-05 17:26:51 +08008421 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008422}
8423
8424/*
8425 * This file defines the Wireless Extension handlers. It does not
8426 * define any methods of hardware manipulation and relies on the
8427 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008428 *
8429 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008430 * function used to poll the hardware vs. making unecessary calls.
8431 *
8432 */
8433
Jeff Garzikbf794512005-07-31 13:07:26 -04008434static int ipw_wx_get_name(struct net_device *dev,
8435 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008436 union iwreq_data *wrqu, char *extra)
8437{
8438 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008439 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008440 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008441 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008442 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008443 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008444 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008445 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8446 ipw_modes[priv->assoc_request.ieee_mode]);
8447 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008448 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008449 return 0;
8450}
8451
8452static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8453{
8454 if (channel == 0) {
8455 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8456 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008457 IPW_DEBUG_ASSOC("Attempting to associate with new "
8458 "parameters.\n");
8459 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008460 return 0;
8461 }
8462
8463 priv->config |= CFG_STATIC_CHANNEL;
8464
8465 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008466 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8467 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008468 return 0;
8469 }
8470
8471 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8472 priv->channel = channel;
8473
James Ketrenosb095c382005-08-24 22:04:42 -05008474#ifdef CONFIG_IPW2200_MONITOR
8475 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008476 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008477 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008478 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008479 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008480 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008481 }
8482
8483 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8484 udelay(10);
8485
8486 if (priv->status & STATUS_SCANNING)
8487 IPW_DEBUG_SCAN("Still scanning...\n");
8488 else
8489 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8490 1000 - i);
8491
8492 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008493 }
James Ketrenosb095c382005-08-24 22:04:42 -05008494#endif /* CONFIG_IPW2200_MONITOR */
8495
James Ketrenosc848d0a2005-08-24 21:56:24 -05008496 /* Network configuration changed -- force [re]association */
8497 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8498 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008499 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008500
8501 return 0;
8502}
8503
Jeff Garzikbf794512005-07-31 13:07:26 -04008504static int ipw_wx_set_freq(struct net_device *dev,
8505 struct iw_request_info *info,
8506 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008507{
8508 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008509 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008510 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008511 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008512 u8 channel, flags;
8513 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008514
James Ketrenosb095c382005-08-24 22:04:42 -05008515 if (fwrq->m == 0) {
8516 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008517 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008518 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008519 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008520 return ret;
8521 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008522 /* if setting by freq convert to channel */
8523 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008524 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008525 if (channel == 0)
8526 return -EINVAL;
8527 } else
8528 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008529
Larry Finger1867b112006-02-28 09:48:28 -06008530 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008531 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008532
Liu Hong1fe0adb2005-08-19 09:33:10 -05008533 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008534 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008535 if (i == -1)
8536 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008537
8538 flags = (band == IEEE80211_24GHZ_BAND) ?
8539 geo->bg[i].flags : geo->a[i].flags;
8540 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008541 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8542 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008543 }
8544 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008545
James Ketrenos43f66a62005-03-25 12:31:53 -06008546 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008547 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008548 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008549 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008550 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008551}
8552
Jeff Garzikbf794512005-07-31 13:07:26 -04008553static int ipw_wx_get_freq(struct net_device *dev,
8554 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008555 union iwreq_data *wrqu, char *extra)
8556{
8557 struct ipw_priv *priv = ieee80211_priv(dev);
8558
8559 wrqu->freq.e = 0;
8560
8561 /* If we are associated, trying to associate, or have a statically
8562 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008563 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008564 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008565 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8566 int i;
8567
8568 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8569 BUG_ON(i == -1);
8570 wrqu->freq.e = 1;
8571
8572 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8573 case IEEE80211_52GHZ_BAND:
8574 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8575 break;
8576
8577 case IEEE80211_24GHZ_BAND:
8578 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8579 break;
8580
8581 default:
8582 BUG();
8583 }
8584 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008585 wrqu->freq.m = 0;
8586
Zhu Yi46441512006-01-24 16:37:59 +08008587 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008588 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8589 return 0;
8590}
8591
Jeff Garzikbf794512005-07-31 13:07:26 -04008592static int ipw_wx_set_mode(struct net_device *dev,
8593 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008594 union iwreq_data *wrqu, char *extra)
8595{
8596 struct ipw_priv *priv = ieee80211_priv(dev);
8597 int err = 0;
8598
8599 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8600
James Ketrenos43f66a62005-03-25 12:31:53 -06008601 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008602#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008603 case IW_MODE_MONITOR:
8604#endif
8605 case IW_MODE_ADHOC:
8606 case IW_MODE_INFRA:
8607 break;
8608 case IW_MODE_AUTO:
8609 wrqu->mode = IW_MODE_INFRA;
8610 break;
8611 default:
8612 return -EINVAL;
8613 }
James Ketrenosb095c382005-08-24 22:04:42 -05008614 if (wrqu->mode == priv->ieee->iw_mode)
8615 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008616
Zhu Yi46441512006-01-24 16:37:59 +08008617 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008618
8619 ipw_sw_reset(priv, 0);
8620
James Ketrenosb095c382005-08-24 22:04:42 -05008621#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008622 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008623 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008624
8625 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008626#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008627 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8628#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008629 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008630#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008631#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008632
Jeff Garzikbf794512005-07-31 13:07:26 -04008633 /* Free the existing firmware and reset the fw_loaded
James Ketrenos43f66a62005-03-25 12:31:53 -06008634 * flag so ipw_load() will bring in the new firmawre */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008635 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008636
8637 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008638
James Ketrenosc848d0a2005-08-24 21:56:24 -05008639 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008640 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008641 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008642}
8643
Jeff Garzikbf794512005-07-31 13:07:26 -04008644static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008645 struct iw_request_info *info,
8646 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008647{
8648 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008649 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008650 wrqu->mode = priv->ieee->iw_mode;
8651 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008652 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008653 return 0;
8654}
8655
James Ketrenos43f66a62005-03-25 12:31:53 -06008656/* Values are in microsecond */
8657static const s32 timeout_duration[] = {
8658 350000,
8659 250000,
8660 75000,
8661 37000,
8662 25000,
8663};
8664
8665static const s32 period_duration[] = {
8666 400000,
8667 700000,
8668 1000000,
8669 1000000,
8670 1000000
8671};
8672
Jeff Garzikbf794512005-07-31 13:07:26 -04008673static int ipw_wx_get_range(struct net_device *dev,
8674 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008675 union iwreq_data *wrqu, char *extra)
8676{
8677 struct ipw_priv *priv = ieee80211_priv(dev);
8678 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008679 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008680 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008681
8682 wrqu->data.length = sizeof(*range);
8683 memset(range, 0, sizeof(*range));
8684
8685 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008686 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008687
8688 range->max_qual.qual = 100;
8689 /* TODO: Find real max RSSI and stick here */
8690 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008691 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008692 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008693
8694 range->avg_qual.qual = 70;
8695 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008696 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008697 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008698 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008699 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008700 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008701
Jeff Garzikbf794512005-07-31 13:07:26 -04008702 for (i = 0; i < range->num_bitrates; i++)
8703 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008704 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008705
James Ketrenos43f66a62005-03-25 12:31:53 -06008706 range->max_rts = DEFAULT_RTS_THRESHOLD;
8707 range->min_frag = MIN_FRAG_THRESHOLD;
8708 range->max_frag = MAX_FRAG_THRESHOLD;
8709
8710 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008711 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008712 range->num_encoding_sizes = 2;
8713 range->max_encoding_tokens = WEP_KEYS;
8714
8715 /* Set the Wireless Extension versions */
8716 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008717 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008718
James Ketrenosb095c382005-08-24 22:04:42 -05008719 i = 0;
8720 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008721 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8722 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8723 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8724 continue;
8725
James Ketrenosb095c382005-08-24 22:04:42 -05008726 range->freq[i].i = geo->bg[j].channel;
8727 range->freq[i].m = geo->bg[j].freq * 100000;
8728 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008729 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008730 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008731 }
James Ketrenosb095c382005-08-24 22:04:42 -05008732
8733 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008734 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8735 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8736 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8737 continue;
8738
James Ketrenosb095c382005-08-24 22:04:42 -05008739 range->freq[i].i = geo->a[j].channel;
8740 range->freq[i].m = geo->a[j].freq * 100000;
8741 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008742 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008743 }
8744 }
8745
8746 range->num_channels = i;
8747 range->num_frequency = i;
8748
Zhu Yi46441512006-01-24 16:37:59 +08008749 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008750
8751 /* Event capability (kernel + driver) */
8752 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8753 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008754 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8755 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008756 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008757
Dan Williamsf1b50862006-01-30 13:58:56 -05008758 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8759 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8760
James Ketrenos43f66a62005-03-25 12:31:53 -06008761 IPW_DEBUG_WX("GET Range\n");
8762 return 0;
8763}
8764
Jeff Garzikbf794512005-07-31 13:07:26 -04008765static int ipw_wx_set_wap(struct net_device *dev,
8766 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008767 union iwreq_data *wrqu, char *extra)
8768{
8769 struct ipw_priv *priv = ieee80211_priv(dev);
8770
8771 static const unsigned char any[] = {
8772 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8773 };
8774 static const unsigned char off[] = {
8775 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8776 };
8777
Jeff Garzikbf794512005-07-31 13:07:26 -04008778 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008779 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008780 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008781 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8782 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8783 /* we disable mandatory BSSID association */
8784 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8785 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008786 IPW_DEBUG_ASSOC("Attempting to associate with new "
8787 "parameters.\n");
8788 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08008789 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008790 return 0;
8791 }
8792
8793 priv->config |= CFG_STATIC_BSSID;
8794 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8795 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008796 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008797 return 0;
8798 }
8799
8800 IPW_DEBUG_WX("Setting mandatory BSSID to " MAC_FMT "\n",
8801 MAC_ARG(wrqu->ap_addr.sa_data));
8802
8803 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
8804
James Ketrenosc848d0a2005-08-24 21:56:24 -05008805 /* Network configuration changed -- force [re]association */
8806 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
8807 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008808 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008809
Zhu Yi46441512006-01-24 16:37:59 +08008810 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008811 return 0;
8812}
8813
Jeff Garzikbf794512005-07-31 13:07:26 -04008814static int ipw_wx_get_wap(struct net_device *dev,
8815 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008816 union iwreq_data *wrqu, char *extra)
8817{
8818 struct ipw_priv *priv = ieee80211_priv(dev);
8819 /* If we are associated, trying to associate, or have a statically
8820 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008821 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04008822 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06008823 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8824 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008825 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06008826 } else
8827 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8828
8829 IPW_DEBUG_WX("Getting WAP BSSID: " MAC_FMT "\n",
8830 MAC_ARG(wrqu->ap_addr.sa_data));
Zhu Yi46441512006-01-24 16:37:59 +08008831 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008832 return 0;
8833}
8834
Jeff Garzikbf794512005-07-31 13:07:26 -04008835static int ipw_wx_set_essid(struct net_device *dev,
8836 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008837 union iwreq_data *wrqu, char *extra)
8838{
8839 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008840 char *essid = ""; /* ANY */
James Ketrenos43f66a62005-03-25 12:31:53 -06008841 int length = 0;
Zhu Yi46441512006-01-24 16:37:59 +08008842 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008843 if (wrqu->essid.flags && wrqu->essid.length) {
8844 length = wrqu->essid.length - 1;
8845 essid = extra;
8846 }
8847 if (length == 0) {
8848 IPW_DEBUG_WX("Setting ESSID to ANY\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008849 if ((priv->config & CFG_STATIC_ESSID) &&
8850 !(priv->status & (STATUS_ASSOCIATED |
James Ketrenos43f66a62005-03-25 12:31:53 -06008851 STATUS_ASSOCIATING))) {
8852 IPW_DEBUG_ASSOC("Attempting to associate with new "
8853 "parameters.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008854 priv->config &= ~CFG_STATIC_ESSID;
James Ketrenos43f66a62005-03-25 12:31:53 -06008855 ipw_associate(priv);
8856 }
Zhu Yi46441512006-01-24 16:37:59 +08008857 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008858 return 0;
8859 }
8860
8861 length = min(length, IW_ESSID_MAX_SIZE);
8862
8863 priv->config |= CFG_STATIC_ESSID;
8864
8865 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)) {
8866 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008867 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008868 return 0;
8869 }
8870
8871 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n", escape_essid(essid, length),
8872 length);
8873
8874 priv->essid_len = length;
8875 memcpy(priv->essid, essid, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04008876
James Ketrenosc848d0a2005-08-24 21:56:24 -05008877 /* Network configuration changed -- force [re]association */
8878 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
8879 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008880 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008881
Zhu Yi46441512006-01-24 16:37:59 +08008882 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008883 return 0;
8884}
8885
Jeff Garzikbf794512005-07-31 13:07:26 -04008886static int ipw_wx_get_essid(struct net_device *dev,
8887 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008888 union iwreq_data *wrqu, char *extra)
8889{
8890 struct ipw_priv *priv = ieee80211_priv(dev);
8891
8892 /* If we are associated, trying to associate, or have a statically
8893 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008894 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008895 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04008896 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8897 IPW_DEBUG_WX("Getting essid: '%s'\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008898 escape_essid(priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04008899 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06008900 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008901 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06008902 } else {
8903 IPW_DEBUG_WX("Getting essid: ANY\n");
8904 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008905 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06008906 }
Zhu Yi46441512006-01-24 16:37:59 +08008907 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008908 return 0;
8909}
8910
Jeff Garzikbf794512005-07-31 13:07:26 -04008911static int ipw_wx_set_nick(struct net_device *dev,
8912 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008913 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04008914{
James Ketrenos43f66a62005-03-25 12:31:53 -06008915 struct ipw_priv *priv = ieee80211_priv(dev);
8916
8917 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
8918 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
8919 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08008920 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008921 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06008922 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008923 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06008924 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08008925 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008926 return 0;
8927
8928}
8929
Jeff Garzikbf794512005-07-31 13:07:26 -04008930static int ipw_wx_get_nick(struct net_device *dev,
8931 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008932 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04008933{
James Ketrenos43f66a62005-03-25 12:31:53 -06008934 struct ipw_priv *priv = ieee80211_priv(dev);
8935 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08008936 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008937 wrqu->data.length = strlen(priv->nick) + 1;
8938 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008939 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08008940 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008941 return 0;
8942}
8943
Olivier Hochreutiner651be262006-03-08 03:13:55 +08008944static int ipw_wx_set_sens(struct net_device *dev,
8945 struct iw_request_info *info,
8946 union iwreq_data *wrqu, char *extra)
8947{
8948 struct ipw_priv *priv = ieee80211_priv(dev);
8949 int err = 0;
8950
8951 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
8952 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
8953 mutex_lock(&priv->mutex);
8954
8955 if (wrqu->sens.fixed == 0)
8956 {
8957 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
8958 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8959 goto out;
8960 }
8961 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
8962 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
8963 err = -EINVAL;
8964 goto out;
8965 }
8966
8967 priv->roaming_threshold = wrqu->sens.value;
8968 priv->disassociate_threshold = 3*wrqu->sens.value;
8969 out:
8970 mutex_unlock(&priv->mutex);
8971 return err;
8972}
8973
8974static int ipw_wx_get_sens(struct net_device *dev,
8975 struct iw_request_info *info,
8976 union iwreq_data *wrqu, char *extra)
8977{
8978 struct ipw_priv *priv = ieee80211_priv(dev);
8979 mutex_lock(&priv->mutex);
8980 wrqu->sens.fixed = 1;
8981 wrqu->sens.value = priv->roaming_threshold;
8982 mutex_unlock(&priv->mutex);
8983
8984 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
8985 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
8986
8987 return 0;
8988}
8989
James Ketrenos43f66a62005-03-25 12:31:53 -06008990static int ipw_wx_set_rate(struct net_device *dev,
8991 struct iw_request_info *info,
8992 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04008993{
James Ketrenosea2b26e2005-08-24 21:25:16 -05008994 /* TODO: We should use semaphores or locks for access to priv */
8995 struct ipw_priv *priv = ieee80211_priv(dev);
8996 u32 target_rate = wrqu->bitrate.value;
8997 u32 fixed, mask;
8998
8999 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9000 /* value = X, fixed = 1 means only rate X */
9001 /* value = X, fixed = 0 means all rates lower equal X */
9002
9003 if (target_rate == -1) {
9004 fixed = 0;
9005 mask = IEEE80211_DEFAULT_RATES_MASK;
9006 /* Now we should reassociate */
9007 goto apply;
9008 }
9009
9010 mask = 0;
9011 fixed = wrqu->bitrate.fixed;
9012
9013 if (target_rate == 1000000 || !fixed)
9014 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9015 if (target_rate == 1000000)
9016 goto apply;
9017
9018 if (target_rate == 2000000 || !fixed)
9019 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9020 if (target_rate == 2000000)
9021 goto apply;
9022
9023 if (target_rate == 5500000 || !fixed)
9024 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9025 if (target_rate == 5500000)
9026 goto apply;
9027
9028 if (target_rate == 6000000 || !fixed)
9029 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9030 if (target_rate == 6000000)
9031 goto apply;
9032
9033 if (target_rate == 9000000 || !fixed)
9034 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9035 if (target_rate == 9000000)
9036 goto apply;
9037
9038 if (target_rate == 11000000 || !fixed)
9039 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9040 if (target_rate == 11000000)
9041 goto apply;
9042
9043 if (target_rate == 12000000 || !fixed)
9044 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9045 if (target_rate == 12000000)
9046 goto apply;
9047
9048 if (target_rate == 18000000 || !fixed)
9049 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9050 if (target_rate == 18000000)
9051 goto apply;
9052
9053 if (target_rate == 24000000 || !fixed)
9054 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9055 if (target_rate == 24000000)
9056 goto apply;
9057
9058 if (target_rate == 36000000 || !fixed)
9059 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9060 if (target_rate == 36000000)
9061 goto apply;
9062
9063 if (target_rate == 48000000 || !fixed)
9064 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9065 if (target_rate == 48000000)
9066 goto apply;
9067
9068 if (target_rate == 54000000 || !fixed)
9069 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9070 if (target_rate == 54000000)
9071 goto apply;
9072
9073 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9074 return -EINVAL;
9075
9076 apply:
9077 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9078 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009079 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009080 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009081 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009082 ipw_set_fixed_rate(priv, priv->ieee->mode);
9083 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009084 priv->config |= CFG_FIXED_RATE;
9085
James Ketrenosc848d0a2005-08-24 21:56:24 -05009086 if (priv->rates_mask == mask) {
9087 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009088 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009089 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009090 }
9091
James Ketrenosc848d0a2005-08-24 21:56:24 -05009092 priv->rates_mask = mask;
9093
9094 /* Network configuration changed -- force [re]association */
9095 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9096 if (!ipw_disassociate(priv))
9097 ipw_associate(priv);
9098
Zhu Yi46441512006-01-24 16:37:59 +08009099 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009100 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009101}
9102
Jeff Garzikbf794512005-07-31 13:07:26 -04009103static int ipw_wx_get_rate(struct net_device *dev,
9104 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009105 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009106{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009107 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009108 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009109 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009110 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009111 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009112 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9113 return 0;
9114}
9115
Jeff Garzikbf794512005-07-31 13:07:26 -04009116static int ipw_wx_set_rts(struct net_device *dev,
9117 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009118 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009119{
James Ketrenos43f66a62005-03-25 12:31:53 -06009120 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009121 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009122 if (wrqu->rts.disabled)
9123 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9124 else {
9125 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009126 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009127 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009128 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009129 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009130 priv->rts_threshold = wrqu->rts.value;
9131 }
9132
9133 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009134 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009135 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9136 return 0;
9137}
9138
Jeff Garzikbf794512005-07-31 13:07:26 -04009139static int ipw_wx_get_rts(struct net_device *dev,
9140 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009141 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009142{
James Ketrenos43f66a62005-03-25 12:31:53 -06009143 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009144 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009145 wrqu->rts.value = priv->rts_threshold;
9146 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009147 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009148 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009149 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9150 return 0;
9151}
9152
Jeff Garzikbf794512005-07-31 13:07:26 -04009153static int ipw_wx_set_txpow(struct net_device *dev,
9154 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009155 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009156{
James Ketrenos43f66a62005-03-25 12:31:53 -06009157 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009158 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009159
Zhu Yi46441512006-01-24 16:37:59 +08009160 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009161 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009162 err = -EINPROGRESS;
9163 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009164 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009165
James Ketrenosb095c382005-08-24 22:04:42 -05009166 if (!wrqu->power.fixed)
9167 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009168
James Ketrenosc848d0a2005-08-24 21:56:24 -05009169 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009170 err = -EINVAL;
9171 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009172 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009173
James Ketrenosb095c382005-08-24 22:04:42 -05009174 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009175 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009176 err = -EINVAL;
9177 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009178 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009179
9180 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009181 err = ipw_set_tx_power(priv);
9182 out:
Zhu Yi46441512006-01-24 16:37:59 +08009183 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009184 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009185}
9186
Jeff Garzikbf794512005-07-31 13:07:26 -04009187static int ipw_wx_get_txpow(struct net_device *dev,
9188 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009189 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009190{
James Ketrenos43f66a62005-03-25 12:31:53 -06009191 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009192 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009193 wrqu->power.value = priv->tx_power;
9194 wrqu->power.fixed = 1;
9195 wrqu->power.flags = IW_TXPOW_DBM;
9196 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009197 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009198
Jeff Garzikbf794512005-07-31 13:07:26 -04009199 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009200 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009201
9202 return 0;
9203}
9204
Jeff Garzikbf794512005-07-31 13:07:26 -04009205static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009206 struct iw_request_info *info,
9207 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009208{
9209 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009210 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009211 if (wrqu->frag.disabled)
9212 priv->ieee->fts = DEFAULT_FTS;
9213 else {
9214 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009215 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009216 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009217 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009218 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009219
James Ketrenos43f66a62005-03-25 12:31:53 -06009220 priv->ieee->fts = wrqu->frag.value & ~0x1;
9221 }
9222
9223 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009224 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009225 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9226 return 0;
9227}
9228
Jeff Garzikbf794512005-07-31 13:07:26 -04009229static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009230 struct iw_request_info *info,
9231 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009232{
9233 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009234 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009235 wrqu->frag.value = priv->ieee->fts;
9236 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009237 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009238 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009239 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9240
9241 return 0;
9242}
9243
Jeff Garzikbf794512005-07-31 13:07:26 -04009244static int ipw_wx_set_retry(struct net_device *dev,
9245 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009246 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009247{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009248 struct ipw_priv *priv = ieee80211_priv(dev);
9249
9250 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9251 return -EINVAL;
9252
9253 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9254 return 0;
9255
9256 if (wrqu->retry.value < 0 || wrqu->retry.value > 255)
9257 return -EINVAL;
9258
Zhu Yi46441512006-01-24 16:37:59 +08009259 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009260 if (wrqu->retry.flags & IW_RETRY_MIN)
9261 priv->short_retry_limit = (u8) wrqu->retry.value;
9262 else if (wrqu->retry.flags & IW_RETRY_MAX)
9263 priv->long_retry_limit = (u8) wrqu->retry.value;
9264 else {
9265 priv->short_retry_limit = (u8) wrqu->retry.value;
9266 priv->long_retry_limit = (u8) wrqu->retry.value;
9267 }
9268
9269 ipw_send_retry_limit(priv, priv->short_retry_limit,
9270 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009271 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009272 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9273 priv->short_retry_limit, priv->long_retry_limit);
9274 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009275}
9276
Jeff Garzikbf794512005-07-31 13:07:26 -04009277static int ipw_wx_get_retry(struct net_device *dev,
9278 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009279 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009280{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009281 struct ipw_priv *priv = ieee80211_priv(dev);
9282
Zhu Yi46441512006-01-24 16:37:59 +08009283 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009284 wrqu->retry.disabled = 0;
9285
9286 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009287 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009288 return -EINVAL;
9289 }
9290
9291 if (wrqu->retry.flags & IW_RETRY_MAX) {
9292 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
9293 wrqu->retry.value = priv->long_retry_limit;
9294 } else if (wrqu->retry.flags & IW_RETRY_MIN) {
9295 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_MIN;
9296 wrqu->retry.value = priv->short_retry_limit;
9297 } else {
9298 wrqu->retry.flags = IW_RETRY_LIMIT;
9299 wrqu->retry.value = priv->short_retry_limit;
9300 }
Zhu Yi46441512006-01-24 16:37:59 +08009301 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009302
9303 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9304
9305 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009306}
9307
James Ketrenosafbf30a2005-08-25 00:05:33 -05009308static int ipw_request_direct_scan(struct ipw_priv *priv, char *essid,
9309 int essid_len)
9310{
9311 struct ipw_scan_request_ext scan;
9312 int err = 0, scan_type;
9313
Pekka Enbergefb34422005-11-16 21:55:05 +02009314 if (!(priv->status & STATUS_INIT) ||
9315 (priv->status & STATUS_EXIT_PENDING))
9316 return 0;
9317
Zhu Yi46441512006-01-24 16:37:59 +08009318 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009319
9320 if (priv->status & STATUS_RF_KILL_MASK) {
9321 IPW_DEBUG_HC("Aborting scan due to RF kill activation\n");
9322 priv->status |= STATUS_SCAN_PENDING;
9323 goto done;
9324 }
9325
9326 IPW_DEBUG_HC("starting request direct scan!\n");
9327
9328 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
Olaf Kirchd834a412006-01-09 17:00:37 +01009329 /* We should not sleep here; otherwise we will block most
9330 * of the system (for instance, we hold rtnl_lock when we
9331 * get here).
9332 */
9333 err = -EAGAIN;
9334 goto done;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009335 }
9336 memset(&scan, 0, sizeof(scan));
9337
9338 if (priv->config & CFG_SPEED_SCAN)
9339 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9340 cpu_to_le16(30);
9341 else
9342 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9343 cpu_to_le16(20);
9344
9345 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
9346 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05009347 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009348 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
9349
9350 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
9351
9352 err = ipw_send_ssid(priv, essid, essid_len);
9353 if (err) {
9354 IPW_DEBUG_HC("Attempt to send SSID command failed\n");
9355 goto done;
9356 }
9357 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
9358
9359 ipw_add_scan_channels(priv, &scan, scan_type);
9360
9361 err = ipw_send_scan_request_ext(priv, &scan);
9362 if (err) {
9363 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
9364 goto done;
9365 }
9366
9367 priv->status |= STATUS_SCANNING;
9368
9369 done:
Zhu Yi46441512006-01-24 16:37:59 +08009370 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009371 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009372}
9373
Jeff Garzikbf794512005-07-31 13:07:26 -04009374static int ipw_wx_set_scan(struct net_device *dev,
9375 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009376 union iwreq_data *wrqu, char *extra)
9377{
9378 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009379 struct iw_scan_req *req = NULL;
9380 if (wrqu->data.length
9381 && wrqu->data.length == sizeof(struct iw_scan_req)) {
9382 req = (struct iw_scan_req *)extra;
9383 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
9384 ipw_request_direct_scan(priv, req->essid,
9385 req->essid_len);
9386 return 0;
9387 }
9388 }
James Ketrenos8935f392005-10-05 15:59:08 -05009389
James Ketrenos43f66a62005-03-25 12:31:53 -06009390 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009391
9392 queue_work(priv->workqueue, &priv->request_scan);
9393
James Ketrenos43f66a62005-03-25 12:31:53 -06009394 return 0;
9395}
9396
Jeff Garzikbf794512005-07-31 13:07:26 -04009397static int ipw_wx_get_scan(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 Ketrenos43f66a62005-03-25 12:31:53 -06009401 struct ipw_priv *priv = ieee80211_priv(dev);
9402 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9403}
9404
Jeff Garzikbf794512005-07-31 13:07:26 -04009405static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009406 struct iw_request_info *info,
9407 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009408{
9409 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009410 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009411 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009412
Zhu Yi46441512006-01-24 16:37:59 +08009413 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009414 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009415
Hong Liucaeff812005-08-05 17:25:50 +08009416 /* In IBSS mode, we need to notify the firmware to update
9417 * the beacon info after we changed the capability. */
9418 if (cap != priv->capability &&
9419 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9420 priv->status & STATUS_ASSOCIATED)
9421 ipw_disassociate(priv);
9422
Zhu Yi46441512006-01-24 16:37:59 +08009423 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009424 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009425}
9426
Jeff Garzikbf794512005-07-31 13:07:26 -04009427static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009428 struct iw_request_info *info,
9429 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009430{
9431 struct ipw_priv *priv = ieee80211_priv(dev);
9432 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9433}
9434
Jeff Garzikbf794512005-07-31 13:07:26 -04009435static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009436 struct iw_request_info *info,
9437 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009438{
9439 struct ipw_priv *priv = ieee80211_priv(dev);
9440 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009441 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009442 if (wrqu->power.disabled) {
9443 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9444 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9445 if (err) {
9446 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009447 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009448 return err;
9449 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009450 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009451 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009452 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009453 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009454
9455 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009456 case IW_POWER_ON: /* If not specified */
9457 case IW_POWER_MODE: /* If set all mask */
9458 case IW_POWER_ALL_R: /* If explicitely state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009459 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009460 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009461 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9462 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009463 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009464 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009465 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009466
James Ketrenos43f66a62005-03-25 12:31:53 -06009467 /* If the user hasn't specified a power management mode yet, default
9468 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009469 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009470 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009471 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009472 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
9473 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9474 if (err) {
9475 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009476 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009477 return err;
9478 }
9479
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009480 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009481 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009482 return 0;
9483}
9484
Jeff Garzikbf794512005-07-31 13:07:26 -04009485static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009486 struct iw_request_info *info,
9487 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009488{
9489 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009490 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009491 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009492 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009493 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009494 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009495
Zhu Yi46441512006-01-24 16:37:59 +08009496 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009497 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009498
James Ketrenos43f66a62005-03-25 12:31:53 -06009499 return 0;
9500}
9501
Jeff Garzikbf794512005-07-31 13:07:26 -04009502static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009503 struct iw_request_info *info,
9504 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009505{
9506 struct ipw_priv *priv = ieee80211_priv(dev);
9507 int mode = *(int *)extra;
9508 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009509 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009510 if ((mode < 1) || (mode > IPW_POWER_LIMIT)) {
9511 mode = IPW_POWER_AC;
9512 priv->power_mode = mode;
9513 } else {
9514 priv->power_mode = IPW_POWER_ENABLED | mode;
9515 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009516
James Ketrenos43f66a62005-03-25 12:31:53 -06009517 if (priv->power_mode != mode) {
9518 err = ipw_send_power_mode(priv, mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009519
James Ketrenos43f66a62005-03-25 12:31:53 -06009520 if (err) {
9521 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009522 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009523 return err;
9524 }
9525 }
Zhu Yi46441512006-01-24 16:37:59 +08009526 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009527 return 0;
9528}
9529
9530#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009531static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009532 struct iw_request_info *info,
9533 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009534{
9535 struct ipw_priv *priv = ieee80211_priv(dev);
9536 int level = IPW_POWER_LEVEL(priv->power_mode);
9537 char *p = extra;
9538
9539 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9540
9541 switch (level) {
9542 case IPW_POWER_AC:
9543 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9544 break;
9545 case IPW_POWER_BATTERY:
9546 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9547 break;
9548 default:
9549 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009550 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009551 timeout_duration[level - 1] / 1000,
9552 period_duration[level - 1] / 1000);
9553 }
9554
9555 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009556 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009557
9558 wrqu->data.length = p - extra + 1;
9559
9560 return 0;
9561}
9562
9563static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009564 struct iw_request_info *info,
9565 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009566{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009567 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009568 int mode = *(int *)extra;
9569 u8 band = 0, modulation = 0;
9570
9571 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009572 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009573 return -EINVAL;
9574 }
Zhu Yi46441512006-01-24 16:37:59 +08009575 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009576 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009577 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009578 if (mode & IEEE_A) {
9579 band |= IEEE80211_52GHZ_BAND;
9580 modulation |= IEEE80211_OFDM_MODULATION;
9581 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009582 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009583 } else {
9584 if (mode & IEEE_A) {
9585 IPW_WARNING("Attempt to set 2200BG into "
9586 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009587 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009588 return -EINVAL;
9589 }
9590
James Ketrenosa33a1982005-09-14 14:28:59 -05009591 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009592 }
9593
9594 if (mode & IEEE_B) {
9595 band |= IEEE80211_24GHZ_BAND;
9596 modulation |= IEEE80211_CCK_MODULATION;
9597 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009598 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009599
James Ketrenos43f66a62005-03-25 12:31:53 -06009600 if (mode & IEEE_G) {
9601 band |= IEEE80211_24GHZ_BAND;
9602 modulation |= IEEE80211_OFDM_MODULATION;
9603 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009604 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009605
9606 priv->ieee->mode = mode;
9607 priv->ieee->freq_band = band;
9608 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009609 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009610
James Ketrenosc848d0a2005-08-24 21:56:24 -05009611 /* Network configuration changed -- force [re]association */
9612 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9613 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009614 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009615 ipw_associate(priv);
9616 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009617
James Ketrenosa613bff2005-08-24 21:43:11 -05009618 /* Update the band LEDs */
9619 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009620
Jeff Garzikbf794512005-07-31 13:07:26 -04009621 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009622 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009623 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009624 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009625 return 0;
9626}
9627
9628static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009629 struct iw_request_info *info,
9630 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009631{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009632 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009633 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009634 switch (priv->ieee->mode) {
9635 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009636 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9637 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009638 case IEEE_B:
9639 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9640 break;
9641 case IEEE_A | IEEE_B:
9642 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9643 break;
9644 case IEEE_G:
9645 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9646 break;
9647 case IEEE_A | IEEE_G:
9648 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9649 break;
9650 case IEEE_B | IEEE_G:
9651 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9652 break;
9653 case IEEE_A | IEEE_B | IEEE_G:
9654 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9655 break;
9656 default:
9657 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009658 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009659 }
9660
James Ketrenos43f66a62005-03-25 12:31:53 -06009661 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9662
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009663 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009664 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009665
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009666 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009667}
9668
James Ketrenosea2b26e2005-08-24 21:25:16 -05009669static int ipw_wx_set_preamble(struct net_device *dev,
9670 struct iw_request_info *info,
9671 union iwreq_data *wrqu, char *extra)
9672{
9673 struct ipw_priv *priv = ieee80211_priv(dev);
9674 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009675 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009676 /* Switching from SHORT -> LONG requires a disassociation */
9677 if (mode == 1) {
9678 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9679 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009680
9681 /* Network configuration changed -- force [re]association */
9682 IPW_DEBUG_ASSOC
9683 ("[re]association triggered due to preamble change.\n");
9684 if (!ipw_disassociate(priv))
9685 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009686 }
9687 goto done;
9688 }
9689
9690 if (mode == 0) {
9691 priv->config &= ~CFG_PREAMBLE_LONG;
9692 goto done;
9693 }
Zhu Yi46441512006-01-24 16:37:59 +08009694 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009695 return -EINVAL;
9696
9697 done:
Zhu Yi46441512006-01-24 16:37:59 +08009698 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009699 return 0;
9700}
9701
9702static int ipw_wx_get_preamble(struct net_device *dev,
9703 struct iw_request_info *info,
9704 union iwreq_data *wrqu, char *extra)
9705{
9706 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009707 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009708 if (priv->config & CFG_PREAMBLE_LONG)
9709 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9710 else
9711 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009712 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009713 return 0;
9714}
9715
James Ketrenosb095c382005-08-24 22:04:42 -05009716#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009717static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009718 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009719 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009720{
James Ketrenos43f66a62005-03-25 12:31:53 -06009721 struct ipw_priv *priv = ieee80211_priv(dev);
9722 int *parms = (int *)extra;
9723 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009724 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009725 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009726 if (enable) {
9727 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009728#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009729 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9730#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009731 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009732#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009733 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009734 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009735
James Ketrenos43f66a62005-03-25 12:31:53 -06009736 ipw_set_channel(priv, parms[1]);
9737 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009738 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009739 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009740 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009741 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009742 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009743 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009744 }
Zhu Yi46441512006-01-24 16:37:59 +08009745 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009746 return 0;
9747}
9748
Pavel Machek67fd6b42006-07-11 15:34:05 +02009749#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009750
Jeff Garzikbf794512005-07-31 13:07:26 -04009751static int ipw_wx_reset(struct net_device *dev,
9752 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009753 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009754{
James Ketrenos43f66a62005-03-25 12:31:53 -06009755 struct ipw_priv *priv = ieee80211_priv(dev);
9756 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009757 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009758 return 0;
9759}
James Ketrenosb095c382005-08-24 22:04:42 -05009760
James Ketrenosb095c382005-08-24 22:04:42 -05009761static int ipw_wx_sw_reset(struct net_device *dev,
9762 struct iw_request_info *info,
9763 union iwreq_data *wrqu, char *extra)
9764{
9765 struct ipw_priv *priv = ieee80211_priv(dev);
9766 union iwreq_data wrqu_sec = {
9767 .encoding = {
9768 .flags = IW_ENCODE_DISABLED,
9769 },
9770 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009771 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009772
9773 IPW_DEBUG_WX("SW_RESET\n");
9774
Zhu Yi46441512006-01-24 16:37:59 +08009775 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009776
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009777 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009778 if (!ret) {
9779 free_firmware();
9780 ipw_adapter_restart(priv);
9781 }
James Ketrenosb095c382005-08-24 22:04:42 -05009782
9783 /* The SW reset bit might have been toggled on by the 'disable'
9784 * module parameter, so take appropriate action */
9785 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9786
Zhu Yi46441512006-01-24 16:37:59 +08009787 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009788 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009789 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009790
9791 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9792 /* Configuration likely changed -- force [re]association */
9793 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9794 "reset.\n");
9795 if (!ipw_disassociate(priv))
9796 ipw_associate(priv);
9797 }
9798
Zhu Yi46441512006-01-24 16:37:59 +08009799 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009800
9801 return 0;
9802}
James Ketrenos43f66a62005-03-25 12:31:53 -06009803
9804/* Rebase the WE IOCTLs to zero for the handler array */
9805#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009806static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009807 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9808 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9809 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9810 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9811 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009812 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9813 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009814 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9815 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9816 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9817 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9818 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9819 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9820 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9821 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9822 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9823 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9824 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9825 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9826 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9827 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9828 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9829 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9830 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9831 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9832 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9833 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9834 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9835 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9836 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009837 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9838 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9839 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9840 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009841 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9842 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
9843 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
9844 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
9845 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
9846 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
9847 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -06009848};
9849
James Ketrenosb095c382005-08-24 22:04:42 -05009850enum {
9851 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
9852 IPW_PRIV_GET_POWER,
9853 IPW_PRIV_SET_MODE,
9854 IPW_PRIV_GET_MODE,
9855 IPW_PRIV_SET_PREAMBLE,
9856 IPW_PRIV_GET_PREAMBLE,
9857 IPW_PRIV_RESET,
9858 IPW_PRIV_SW_RESET,
9859#ifdef CONFIG_IPW2200_MONITOR
9860 IPW_PRIV_SET_MONITOR,
9861#endif
9862};
James Ketrenos43f66a62005-03-25 12:31:53 -06009863
Jeff Garzikbf794512005-07-31 13:07:26 -04009864static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -06009865 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009866 .cmd = IPW_PRIV_SET_POWER,
9867 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9868 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009869 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009870 .cmd = IPW_PRIV_GET_POWER,
9871 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9872 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009873 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009874 .cmd = IPW_PRIV_SET_MODE,
9875 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9876 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009877 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009878 .cmd = IPW_PRIV_GET_MODE,
9879 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9880 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009881 {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009882 .cmd = IPW_PRIV_SET_PREAMBLE,
9883 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9884 .name = "set_preamble"},
9885 {
9886 .cmd = IPW_PRIV_GET_PREAMBLE,
9887 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
9888 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009889 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009890 IPW_PRIV_RESET,
9891 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -05009892 {
9893 IPW_PRIV_SW_RESET,
9894 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
9895#ifdef CONFIG_IPW2200_MONITOR
9896 {
9897 IPW_PRIV_SET_MONITOR,
9898 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
9899#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -06009900};
9901
9902static iw_handler ipw_priv_handler[] = {
9903 ipw_wx_set_powermode,
9904 ipw_wx_get_powermode,
9905 ipw_wx_set_wireless_mode,
9906 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009907 ipw_wx_set_preamble,
9908 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -04009909 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -05009910 ipw_wx_sw_reset,
9911#ifdef CONFIG_IPW2200_MONITOR
9912 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -06009913#endif
9914};
9915
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009916static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009917 .standard = ipw_wx_handlers,
9918 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
9919 .num_private = ARRAY_SIZE(ipw_priv_handler),
9920 .num_private_args = ARRAY_SIZE(ipw_priv_args),
9921 .private = ipw_priv_handler,
9922 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00009923 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06009924};
9925
James Ketrenos43f66a62005-03-25 12:31:53 -06009926/*
9927 * Get wireless statistics.
9928 * Called by /proc/net/wireless
9929 * Also called by SIOCGIWSTATS
9930 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009931static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -06009932{
9933 struct ipw_priv *priv = ieee80211_priv(dev);
9934 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -04009935
James Ketrenos43f66a62005-03-25 12:31:53 -06009936 wstats = &priv->wstats;
9937
James Ketrenosea2b26e2005-08-24 21:25:16 -05009938 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -05009939 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -06009940 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
9941 * and associated; if not associcated, the values are all meaningless
9942 * anyway, so set them all to NULL and INVALID */
9943 if (!(priv->status & STATUS_ASSOCIATED)) {
9944 wstats->miss.beacon = 0;
9945 wstats->discard.retries = 0;
9946 wstats->qual.qual = 0;
9947 wstats->qual.level = 0;
9948 wstats->qual.noise = 0;
9949 wstats->qual.updated = 7;
9950 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009951 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -06009952 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -04009953 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009954
9955 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +08009956 wstats->qual.level = priv->exp_avg_rssi;
9957 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -06009958 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +08009959 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -06009960
9961 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
9962 wstats->discard.retries = priv->last_tx_failures;
9963 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -04009964
James Ketrenos43f66a62005-03-25 12:31:53 -06009965/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
9966 goto fail_get_ordinal;
9967 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -04009968
James Ketrenos43f66a62005-03-25 12:31:53 -06009969 return wstats;
9970}
9971
James Ketrenos43f66a62005-03-25 12:31:53 -06009972/* net device stuff */
9973
Arjan van de Ven858119e2006-01-14 13:20:43 -08009974static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -06009975{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009976 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +08009977 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009978 sys_config->answer_broadcast_ssid_probe = 0;
9979 sys_config->accept_all_data_frames = 0;
9980 sys_config->accept_non_directed_frames = 1;
9981 sys_config->exclude_unicast_unencrypted = 0;
9982 sys_config->disable_unicast_decryption = 1;
9983 sys_config->exclude_multicast_unencrypted = 0;
9984 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +08009985 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
9986 antenna = CFG_SYS_ANTENNA_BOTH;
9987 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009988 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -06009989 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009990 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009991 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +02009992 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +08009993 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -06009994}
9995
9996static int ipw_net_open(struct net_device *dev)
9997{
9998 struct ipw_priv *priv = ieee80211_priv(dev);
9999 IPW_DEBUG_INFO("dev->open\n");
10000 /* we should be verifying the device is ready to be opened */
Zhu Yi46441512006-01-24 16:37:59 +080010001 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -040010002 if (!(priv->status & STATUS_RF_KILL_MASK) &&
10003 (priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -060010004 netif_start_queue(dev);
Zhu Yi46441512006-01-24 16:37:59 +080010005 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010006 return 0;
10007}
10008
10009static int ipw_net_stop(struct net_device *dev)
10010{
10011 IPW_DEBUG_INFO("dev->close\n");
10012 netif_stop_queue(dev);
10013 return 0;
10014}
10015
10016/*
10017todo:
10018
10019modify to send one tfd per fragment instead of using chunking. otherwise
10020we need to heavily modify the ieee80211_skb_to_txb.
10021*/
10022
Arjan van de Ven858119e2006-01-14 13:20:43 -080010023static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010024 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010025{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010026 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010027 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010028 int i = 0;
10029 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010030#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010031 int tx_id = ipw_get_tx_queue_number(priv, pri);
10032 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10033#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010034 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010035#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010036 struct clx2_queue *q = &txq->q;
10037 u8 id, hdr_len, unicast;
10038 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010039 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010040
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010041 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010042 switch (priv->ieee->iw_mode) {
10043 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010044 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010045 id = ipw_find_station(priv, hdr->addr1);
10046 if (id == IPW_INVALID_STATION) {
10047 id = ipw_add_station(priv, hdr->addr1);
10048 if (id == IPW_INVALID_STATION) {
10049 IPW_WARNING("Attempt to send data to "
Jeff Garzikbf794512005-07-31 13:07:26 -040010050 "invalid cell: " MAC_FMT "\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010051 MAC_ARG(hdr->addr1));
10052 goto drop;
10053 }
10054 }
10055 break;
10056
10057 case IW_MODE_INFRA:
10058 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010059 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010060 id = 0;
10061 break;
10062 }
10063
10064 tfd = &txq->bd[q->first_empty];
10065 txq->txb[q->first_empty] = txb;
10066 memset(tfd, 0, sizeof(*tfd));
10067 tfd->u.data.station_number = id;
10068
10069 tfd->control_flags.message_type = TX_FRAME_TYPE;
10070 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10071
10072 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010073 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010074 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010075
James Ketrenos43f66a62005-03-25 12:31:53 -060010076 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010077 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010078 else
James Ketrenosb095c382005-08-24 22:04:42 -050010079 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010080
James Ketrenosea2b26e2005-08-24 21:25:16 -050010081 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10082 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010083
James Ketrenosc848d0a2005-08-24 21:56:24 -050010084 fc = le16_to_cpu(hdr->frame_ctl);
10085 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010086
10087 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10088
James Ketrenosb095c382005-08-24 22:04:42 -050010089 if (likely(unicast))
10090 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10091
10092 if (txb->encrypted && !priv->ieee->host_encrypt) {
10093 switch (priv->ieee->sec.level) {
10094 case SEC_LEVEL_3:
10095 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
10096 IEEE80211_FCTL_PROTECTED;
10097 /* XXX: ACK flag must be set for CCMP even if it
10098 * is a multicast/broadcast packet, because CCMP
10099 * group communication encrypted by GTK is
10100 * actually done by the AP. */
10101 if (!unicast)
10102 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10103
10104 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10105 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10106 tfd->u.data.key_index = 0;
10107 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10108 break;
10109 case SEC_LEVEL_2:
10110 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
10111 IEEE80211_FCTL_PROTECTED;
10112 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10113 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10114 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10115 break;
10116 case SEC_LEVEL_1:
10117 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
10118 IEEE80211_FCTL_PROTECTED;
10119 tfd->u.data.key_index = priv->ieee->tx_keyidx;
10120 if (priv->ieee->sec.key_sizes[priv->ieee->tx_keyidx] <=
10121 40)
10122 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10123 else
10124 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10125 break;
10126 case SEC_LEVEL_0:
10127 break;
10128 default:
10129 printk(KERN_ERR "Unknow security level %d\n",
10130 priv->ieee->sec.level);
10131 break;
10132 }
10133 } else
10134 /* No hardware encryption */
10135 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10136
Zhu Yie43e3c12006-04-13 17:20:45 +080010137#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010138 if (fc & IEEE80211_STYPE_QOS_DATA)
10139 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010140#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010141
James Ketrenos43f66a62005-03-25 12:31:53 -060010142 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010143 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10144 txb->nr_frags));
10145 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10146 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10147 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10148 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10149 i, le32_to_cpu(tfd->u.data.num_chunks),
10150 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010151 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010152 i, tfd->u.data.num_chunks,
10153 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010154 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010155 txb->fragments[i]->len - hdr_len);
10156
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010157 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010158 cpu_to_le32(pci_map_single
10159 (priv->pci_dev,
10160 txb->fragments[i]->data + hdr_len,
10161 txb->fragments[i]->len - hdr_len,
10162 PCI_DMA_TODEVICE));
10163 tfd->u.data.chunk_len[i] =
10164 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010165 }
10166
10167 if (i != txb->nr_frags) {
10168 struct sk_buff *skb;
10169 u16 remaining_bytes = 0;
10170 int j;
10171
10172 for (j = i; j < txb->nr_frags; j++)
10173 remaining_bytes += txb->fragments[j]->len - hdr_len;
10174
10175 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10176 remaining_bytes);
10177 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10178 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010179 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010180 for (j = i; j < txb->nr_frags; j++) {
10181 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010182
James Ketrenos43f66a62005-03-25 12:31:53 -060010183 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010184 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010185 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010186 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010187 }
10188 dev_kfree_skb_any(txb->fragments[i]);
10189 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010190 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010191 cpu_to_le32(pci_map_single
10192 (priv->pci_dev, skb->data,
10193 tfd->u.data.chunk_len[i],
10194 PCI_DMA_TODEVICE));
10195
10196 tfd->u.data.num_chunks =
10197 cpu_to_le32(le32_to_cpu(tfd->u.data.num_chunks) +
10198 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010199 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010200 }
10201
10202 /* kick DMA */
10203 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10204 ipw_write32(priv, q->reg_w, q->first_empty);
10205
James Ketrenosf6970142006-02-14 09:10:51 +080010206 if (ipw_queue_space(q) < q->high_mark)
10207 netif_stop_queue(priv->net_dev);
10208
James Ketrenos227d2dc2005-07-28 16:25:55 -050010209 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010210
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010211 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010212 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10213 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010214 return NETDEV_TX_OK;
10215}
10216
10217static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10218{
10219 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010220#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010221 int tx_id = ipw_get_tx_queue_number(priv, pri);
10222 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10223#else
10224 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010225#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010226
10227 if (ipw_queue_space(&txq->q) < txq->q.high_mark)
10228 return 1;
10229
10230 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010231}
10232
Zhu Yid685b8c2006-04-13 17:20:27 +080010233#ifdef CONFIG_IPW2200_PROMISCUOUS
10234static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10235 struct ieee80211_txb *txb)
10236{
10237 struct ieee80211_rx_stats dummystats;
10238 struct ieee80211_hdr *hdr;
10239 u8 n;
10240 u16 filter = priv->prom_priv->filter;
10241 int hdr_only = 0;
10242
10243 if (filter & IPW_PROM_NO_TX)
10244 return;
10245
10246 memset(&dummystats, 0, sizeof(dummystats));
10247
10248 /* Filtering of fragment chains is done agains the first fragment */
10249 hdr = (void *)txb->fragments[0]->data;
10250 if (ieee80211_is_management(hdr->frame_ctl)) {
10251 if (filter & IPW_PROM_NO_MGMT)
10252 return;
10253 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10254 hdr_only = 1;
10255 } else if (ieee80211_is_control(hdr->frame_ctl)) {
10256 if (filter & IPW_PROM_NO_CTL)
10257 return;
10258 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10259 hdr_only = 1;
10260 } else if (ieee80211_is_data(hdr->frame_ctl)) {
10261 if (filter & IPW_PROM_NO_DATA)
10262 return;
10263 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10264 hdr_only = 1;
10265 }
10266
10267 for(n=0; n<txb->nr_frags; ++n) {
10268 struct sk_buff *src = txb->fragments[n];
10269 struct sk_buff *dst;
10270 struct ieee80211_radiotap_header *rt_hdr;
10271 int len;
10272
10273 if (hdr_only) {
10274 hdr = (void *)src->data;
10275 len = ieee80211_get_hdrlen(hdr->frame_ctl);
10276 } else
10277 len = src->len;
10278
10279 dst = alloc_skb(
10280 len + IEEE80211_RADIOTAP_HDRLEN, GFP_ATOMIC);
10281 if (!dst) continue;
10282
10283 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10284
10285 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10286 rt_hdr->it_pad = 0;
10287 rt_hdr->it_present = 0; /* after all, it's just an idea */
10288 rt_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL);
10289
10290 *(u16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
10291 ieee80211chan2mhz(priv->channel));
10292 if (priv->channel > 14) /* 802.11a */
10293 *(u16*)skb_put(dst, sizeof(u16)) =
10294 cpu_to_le16(IEEE80211_CHAN_OFDM |
10295 IEEE80211_CHAN_5GHZ);
10296 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
10297 *(u16*)skb_put(dst, sizeof(u16)) =
10298 cpu_to_le16(IEEE80211_CHAN_CCK |
10299 IEEE80211_CHAN_2GHZ);
10300 else /* 802.11g */
10301 *(u16*)skb_put(dst, sizeof(u16)) =
10302 cpu_to_le16(IEEE80211_CHAN_OFDM |
10303 IEEE80211_CHAN_2GHZ);
10304
10305 rt_hdr->it_len = dst->len;
10306
10307 memcpy(skb_put(dst, len), src->data, len);
10308
10309 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10310 dev_kfree_skb_any(dst);
10311 }
10312}
10313#endif
10314
James Ketrenos43f66a62005-03-25 12:31:53 -060010315static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010316 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010317{
10318 struct ipw_priv *priv = ieee80211_priv(dev);
10319 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010320 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010321
10322 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010323 spin_lock_irqsave(&priv->lock, flags);
10324
10325 if (!(priv->status & STATUS_ASSOCIATED)) {
10326 IPW_DEBUG_INFO("Tx attempt while not associated.\n");
10327 priv->ieee->stats.tx_carrier_errors++;
10328 netif_stop_queue(dev);
10329 goto fail_unlock;
10330 }
10331
Zhu Yid685b8c2006-04-13 17:20:27 +080010332#ifdef CONFIG_IPW2200_PROMISCUOUS
10333 if (rtap_iface && netif_running(priv->prom_net_dev))
10334 ipw_handle_promiscuous_tx(priv, txb);
10335#endif
10336
James Ketrenos227d2dc2005-07-28 16:25:55 -050010337 ret = ipw_tx_skb(priv, txb, pri);
10338 if (ret == NETDEV_TX_OK)
10339 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010340 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010341
James Ketrenos227d2dc2005-07-28 16:25:55 -050010342 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010343
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010344 fail_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010345 spin_unlock_irqrestore(&priv->lock, flags);
10346 return 1;
10347}
10348
10349static struct net_device_stats *ipw_net_get_stats(struct net_device *dev)
10350{
10351 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzikbf794512005-07-31 13:07:26 -040010352
James Ketrenos43f66a62005-03-25 12:31:53 -060010353 priv->ieee->stats.tx_packets = priv->tx_packets;
10354 priv->ieee->stats.rx_packets = priv->rx_packets;
10355 return &priv->ieee->stats;
10356}
10357
10358static void ipw_net_set_multicast_list(struct net_device *dev)
10359{
10360
10361}
10362
10363static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10364{
10365 struct ipw_priv *priv = ieee80211_priv(dev);
10366 struct sockaddr *addr = p;
10367 if (!is_valid_ether_addr(addr->sa_data))
10368 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010369 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010370 priv->config |= CFG_CUSTOM_MAC;
10371 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
10372 printk(KERN_INFO "%s: Setting MAC to " MAC_FMT "\n",
10373 priv->net_dev->name, MAC_ARG(priv->mac_addr));
James Ketrenosa613bff2005-08-24 21:43:11 -050010374 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010375 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010376 return 0;
10377}
10378
Jeff Garzikbf794512005-07-31 13:07:26 -040010379static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010380 struct ethtool_drvinfo *info)
10381{
10382 struct ipw_priv *p = ieee80211_priv(dev);
10383 char vers[64];
10384 char date[32];
10385 u32 len;
10386
10387 strcpy(info->driver, DRV_NAME);
10388 strcpy(info->version, DRV_VERSION);
10389
10390 len = sizeof(vers);
10391 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10392 len = sizeof(date);
10393 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10394
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010395 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010396 vers, date);
10397 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010398 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010399}
10400
10401static u32 ipw_ethtool_get_link(struct net_device *dev)
10402{
10403 struct ipw_priv *priv = ieee80211_priv(dev);
10404 return (priv->status & STATUS_ASSOCIATED) != 0;
10405}
10406
10407static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10408{
James Ketrenosb095c382005-08-24 22:04:42 -050010409 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010410}
10411
10412static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010413 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010414{
10415 struct ipw_priv *p = ieee80211_priv(dev);
10416
James Ketrenosb095c382005-08-24 22:04:42 -050010417 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010418 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010419 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010420 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010421 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010422 return 0;
10423}
10424
10425static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010426 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010427{
10428 struct ipw_priv *p = ieee80211_priv(dev);
10429 int i;
10430
James Ketrenosb095c382005-08-24 22:04:42 -050010431 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010432 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010433 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010434 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010435 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10436 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010437 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010438 return 0;
10439}
10440
10441static struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010442 .get_link = ipw_ethtool_get_link,
10443 .get_drvinfo = ipw_ethtool_get_drvinfo,
10444 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10445 .get_eeprom = ipw_ethtool_get_eeprom,
10446 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010447};
10448
10449static irqreturn_t ipw_isr(int irq, void *data, struct pt_regs *regs)
10450{
10451 struct ipw_priv *priv = data;
10452 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010453
James Ketrenos43f66a62005-03-25 12:31:53 -060010454 if (!priv)
10455 return IRQ_NONE;
10456
Zhu Yi89c318e2006-06-08 22:19:49 -070010457 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010458
10459 if (!(priv->status & STATUS_INT_ENABLED)) {
10460 /* Shared IRQ */
10461 goto none;
10462 }
10463
James Ketrenosb095c382005-08-24 22:04:42 -050010464 inta = ipw_read32(priv, IPW_INTA_RW);
10465 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010466
James Ketrenos43f66a62005-03-25 12:31:53 -060010467 if (inta == 0xFFFFFFFF) {
10468 /* Hardware disappeared */
10469 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10470 goto none;
10471 }
10472
James Ketrenosb095c382005-08-24 22:04:42 -050010473 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010474 /* Shared interrupt */
10475 goto none;
10476 }
10477
10478 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010479 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010480
James Ketrenos43f66a62005-03-25 12:31:53 -060010481 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010482 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10483 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010484
James Ketrenos43f66a62005-03-25 12:31:53 -060010485 /* Cache INTA value for our tasklet */
10486 priv->isr_inta = inta;
10487
10488 tasklet_schedule(&priv->irq_tasklet);
10489
Zhu Yi89c318e2006-06-08 22:19:49 -070010490 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010491
10492 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010493 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010494 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010495 return IRQ_NONE;
10496}
10497
10498static void ipw_rf_kill(void *adapter)
10499{
10500 struct ipw_priv *priv = adapter;
10501 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010502
James Ketrenos43f66a62005-03-25 12:31:53 -060010503 spin_lock_irqsave(&priv->lock, flags);
10504
10505 if (rf_kill_active(priv)) {
10506 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10507 if (priv->workqueue)
10508 queue_delayed_work(priv->workqueue,
10509 &priv->rf_kill, 2 * HZ);
10510 goto exit_unlock;
10511 }
10512
10513 /* RF Kill is now disabled, so bring the device back up */
10514
10515 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10516 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10517 "device\n");
10518
10519 /* we can not do an adapter restart while inside an irq lock */
10520 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010521 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010522 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10523 "enabled\n");
10524
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010525 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010526 spin_unlock_irqrestore(&priv->lock, flags);
10527}
10528
James Ketrenosc848d0a2005-08-24 21:56:24 -050010529static void ipw_bg_rf_kill(void *data)
10530{
10531 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010532 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010533 ipw_rf_kill(data);
Zhu Yi46441512006-01-24 16:37:59 +080010534 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010535}
10536
Adrian Bunka73e22b2006-01-21 01:39:42 +010010537static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010538{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010539 priv->last_seq_num = -1;
10540 priv->last_frag_num = -1;
10541 priv->last_packet_time = 0;
10542
James Ketrenosa613bff2005-08-24 21:43:11 -050010543 netif_carrier_on(priv->net_dev);
10544 if (netif_queue_stopped(priv->net_dev)) {
10545 IPW_DEBUG_NOTIF("waking queue\n");
10546 netif_wake_queue(priv->net_dev);
10547 } else {
10548 IPW_DEBUG_NOTIF("starting queue\n");
10549 netif_start_queue(priv->net_dev);
10550 }
10551
James Ketrenosc848d0a2005-08-24 21:56:24 -050010552 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -050010553 ipw_reset_stats(priv);
10554 /* Ensure the rate is updated immediately */
10555 priv->last_rate = ipw_get_current_rate(priv);
10556 ipw_gather_stats(priv);
10557 ipw_led_link_up(priv);
10558 notify_wx_assoc_event(priv);
10559
10560 if (priv->config & CFG_BACKGROUND_SCAN)
10561 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10562}
10563
James Ketrenosc848d0a2005-08-24 21:56:24 -050010564static void ipw_bg_link_up(void *data)
10565{
10566 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010567 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010568 ipw_link_up(data);
Zhu Yi46441512006-01-24 16:37:59 +080010569 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010570}
10571
Adrian Bunka73e22b2006-01-21 01:39:42 +010010572static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010573{
10574 ipw_led_link_down(priv);
10575 netif_carrier_off(priv->net_dev);
10576 netif_stop_queue(priv->net_dev);
10577 notify_wx_assoc_event(priv);
10578
10579 /* Cancel any queued work ... */
10580 cancel_delayed_work(&priv->request_scan);
10581 cancel_delayed_work(&priv->adhoc_check);
10582 cancel_delayed_work(&priv->gather_stats);
10583
10584 ipw_reset_stats(priv);
10585
James Ketrenosafbf30a2005-08-25 00:05:33 -050010586 if (!(priv->status & STATUS_EXIT_PENDING)) {
10587 /* Queue up another scan... */
10588 queue_work(priv->workqueue, &priv->request_scan);
10589 }
James Ketrenosa613bff2005-08-24 21:43:11 -050010590}
10591
James Ketrenosc848d0a2005-08-24 21:56:24 -050010592static void ipw_bg_link_down(void *data)
10593{
10594 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010595 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010596 ipw_link_down(data);
Zhu Yi46441512006-01-24 16:37:59 +080010597 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010598}
10599
James Ketrenos43f66a62005-03-25 12:31:53 -060010600static int ipw_setup_deferred_work(struct ipw_priv *priv)
10601{
10602 int ret = 0;
10603
James Ketrenos43f66a62005-03-25 12:31:53 -060010604 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010605 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010606 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010607
James Ketrenosc848d0a2005-08-24 21:56:24 -050010608 INIT_WORK(&priv->adhoc_check, ipw_bg_adhoc_check, priv);
10609 INIT_WORK(&priv->associate, ipw_bg_associate, priv);
10610 INIT_WORK(&priv->disassociate, ipw_bg_disassociate, priv);
Zhu Yid8bad6d2005-07-13 12:25:38 -050010611 INIT_WORK(&priv->system_config, ipw_system_config, priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010612 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish, priv);
10613 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart, priv);
10614 INIT_WORK(&priv->rf_kill, ipw_bg_rf_kill, priv);
10615 INIT_WORK(&priv->up, (void (*)(void *))ipw_bg_up, priv);
10616 INIT_WORK(&priv->down, (void (*)(void *))ipw_bg_down, priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010617 INIT_WORK(&priv->request_scan,
James Ketrenos43f66a62005-03-25 12:31:53 -060010618 (void (*)(void *))ipw_request_scan, priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010619 INIT_WORK(&priv->gather_stats,
James Ketrenosc848d0a2005-08-24 21:56:24 -050010620 (void (*)(void *))ipw_bg_gather_stats, priv);
10621 INIT_WORK(&priv->abort_scan, (void (*)(void *))ipw_bg_abort_scan, priv);
10622 INIT_WORK(&priv->roam, ipw_bg_roam, priv);
10623 INIT_WORK(&priv->scan_check, ipw_bg_scan_check, priv);
10624 INIT_WORK(&priv->link_up, (void (*)(void *))ipw_bg_link_up, priv);
10625 INIT_WORK(&priv->link_down, (void (*)(void *))ipw_bg_link_down, priv);
10626 INIT_WORK(&priv->led_link_on, (void (*)(void *))ipw_bg_led_link_on,
James Ketrenosa613bff2005-08-24 21:43:11 -050010627 priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010628 INIT_WORK(&priv->led_link_off, (void (*)(void *))ipw_bg_led_link_off,
James Ketrenosa613bff2005-08-24 21:43:11 -050010629 priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010630 INIT_WORK(&priv->led_act_off, (void (*)(void *))ipw_bg_led_activity_off,
10631 priv);
10632 INIT_WORK(&priv->merge_networks,
10633 (void (*)(void *))ipw_merge_adhoc_network, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010634
Zhu Yie43e3c12006-04-13 17:20:45 +080010635#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010636 INIT_WORK(&priv->qos_activate, (void (*)(void *))ipw_bg_qos_activate,
10637 priv);
Zhu Yie43e3c12006-04-13 17:20:45 +080010638#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010639
10640 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10641 ipw_irq_tasklet, (unsigned long)priv);
10642
10643 return ret;
10644}
10645
James Ketrenos43f66a62005-03-25 12:31:53 -060010646static void shim__set_security(struct net_device *dev,
10647 struct ieee80211_security *sec)
10648{
10649 struct ipw_priv *priv = ieee80211_priv(dev);
10650 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010651 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010652 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010653 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010654 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010655 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010656 priv->ieee->sec.flags &= ~(1 << i);
10657 else {
10658 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010659 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010660 priv->ieee->sec.flags |= (1 << i);
10661 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010662 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010663 } else if (sec->level != SEC_LEVEL_1)
10664 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010665 }
10666
James Ketrenosb095c382005-08-24 22:04:42 -050010667 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010668 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010669 priv->ieee->sec.active_key = sec->active_key;
10670 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010671 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010672 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010673 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010674 } else
10675 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010676
10677 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010678 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10679 priv->ieee->sec.auth_mode = sec->auth_mode;
10680 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010681 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10682 priv->capability |= CAP_SHARED_KEY;
10683 else
10684 priv->capability &= ~CAP_SHARED_KEY;
10685 priv->status |= STATUS_SECURITY_UPDATED;
10686 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010687
James Ketrenosb095c382005-08-24 22:04:42 -050010688 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10689 priv->ieee->sec.flags |= SEC_ENABLED;
10690 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010691 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010692 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010693 priv->capability |= CAP_PRIVACY_ON;
10694 else
10695 priv->capability &= ~CAP_PRIVACY_ON;
10696 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010697
James Ketrenosafbf30a2005-08-25 00:05:33 -050010698 if (sec->flags & SEC_ENCRYPT)
10699 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010700
James Ketrenosb095c382005-08-24 22:04:42 -050010701 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10702 priv->ieee->sec.level = sec->level;
10703 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010704 priv->status |= STATUS_SECURITY_UPDATED;
10705 }
10706
Zhu Yi1fbfea52005-08-05 17:22:56 +080010707 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10708 ipw_set_hwcrypto_keys(priv);
10709
Jeff Garzikbf794512005-07-31 13:07:26 -040010710 /* To match current functionality of ipw2100 (which works well w/
10711 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010712 * privacy capability changes ... */
10713#if 0
10714 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010715 (((priv->assoc_request.capability &
James Ketrenos43f66a62005-03-25 12:31:53 -060010716 WLAN_CAPABILITY_PRIVACY) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010717 (!(priv->assoc_request.capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010718 WLAN_CAPABILITY_PRIVACY) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010719 IPW_DEBUG_ASSOC("Disassociating due to capability "
10720 "change.\n");
10721 ipw_disassociate(priv);
10722 }
10723#endif
10724}
10725
Jeff Garzikbf794512005-07-31 13:07:26 -040010726static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010727 struct ipw_supported_rates *rates)
10728{
10729 /* TODO: Mask out rates based on priv->rates_mask */
10730
10731 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010732 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010733 switch (priv->ieee->freq_band) {
10734 case IEEE80211_52GHZ_BAND:
10735 rates->ieee_mode = IPW_A_MODE;
10736 rates->purpose = IPW_RATE_CAPABILITIES;
10737 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10738 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10739 break;
10740
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010741 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010742 rates->ieee_mode = IPW_G_MODE;
10743 rates->purpose = IPW_RATE_CAPABILITIES;
10744 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10745 IEEE80211_CCK_DEFAULT_RATES_MASK);
10746 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10747 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10748 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10749 }
10750 break;
10751 }
10752
10753 return 0;
10754}
10755
Jeff Garzikbf794512005-07-31 13:07:26 -040010756static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010757{
James Ketrenos43f66a62005-03-25 12:31:53 -060010758 /* This is only called from ipw_up, which resets/reloads the firmware
10759 so, we don't need to first disable the card before we configure
10760 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010761 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010762 goto error;
10763
10764 /* initialize adapter address */
10765 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10766 goto error;
10767
10768 /* set basic system config settings */
10769 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010770
10771 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10772 * Does not support BT priority yet (don't abort or defer our Tx) */
10773 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010774 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010775
10776 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10777 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010778 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010779 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10780 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010781 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010782 }
10783
Zhu Yid685b8c2006-04-13 17:20:27 +080010784#ifdef CONFIG_IPW2200_PROMISCUOUS
10785 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10786 priv->sys_config.accept_all_data_frames = 1;
10787 priv->sys_config.accept_non_directed_frames = 1;
10788 priv->sys_config.accept_all_mgmt_bcpr = 1;
10789 priv->sys_config.accept_all_mgmt_frames = 1;
10790 }
10791#endif
10792
James Ketrenosc848d0a2005-08-24 21:56:24 -050010793 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10794 priv->sys_config.answer_broadcast_ssid_probe = 1;
10795 else
10796 priv->sys_config.answer_broadcast_ssid_probe = 0;
10797
Zhu Yid685b8c2006-04-13 17:20:27 +080010798 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010799 goto error;
10800
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010801 init_supported_rates(priv, &priv->rates);
10802 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010803 goto error;
10804
10805 /* Set request-to-send threshold */
10806 if (priv->rts_threshold) {
10807 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10808 goto error;
10809 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010810#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010811 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10812 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010813#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010814
10815 if (ipw_set_random_seed(priv))
10816 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010817
James Ketrenos43f66a62005-03-25 12:31:53 -060010818 /* final state transition to the RUN state */
10819 if (ipw_send_host_complete(priv))
10820 goto error;
10821
James Ketrenose6666192005-08-12 09:17:04 -050010822 priv->status |= STATUS_INIT;
10823
10824 ipw_led_init(priv);
10825 ipw_led_radio_on(priv);
10826 priv->notif_missed_beacons = 0;
10827
10828 /* Set hardware WEP key if it is configured. */
10829 if ((priv->capability & CAP_PRIVACY_ON) &&
10830 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10831 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10832 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010833
10834 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010835
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010836 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010837 return -EIO;
10838}
10839
James Ketrenos4f36f802005-08-03 20:36:56 -050010840/*
10841 * NOTE:
10842 *
10843 * These tables have been tested in conjunction with the
10844 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
10845 *
10846 * Altering this values, using it on other hardware, or in geographies
10847 * not intended for resale of the above mentioned Intel adapters has
10848 * not been tested.
10849 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080010850 * Remember to update the table in README.ipw2200 when changing this
10851 * table.
10852 *
James Ketrenos4f36f802005-08-03 20:36:56 -050010853 */
10854static const struct ieee80211_geo ipw_geos[] = {
10855 { /* Restricted */
10856 "---",
10857 .bg_channels = 11,
10858 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10859 {2427, 4}, {2432, 5}, {2437, 6},
10860 {2442, 7}, {2447, 8}, {2452, 9},
10861 {2457, 10}, {2462, 11}},
10862 },
10863
10864 { /* Custom US/Canada */
10865 "ZZF",
10866 .bg_channels = 11,
10867 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10868 {2427, 4}, {2432, 5}, {2437, 6},
10869 {2442, 7}, {2447, 8}, {2452, 9},
10870 {2457, 10}, {2462, 11}},
10871 .a_channels = 8,
10872 .a = {{5180, 36},
10873 {5200, 40},
10874 {5220, 44},
10875 {5240, 48},
10876 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10877 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10878 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10879 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
10880 },
10881
10882 { /* Rest of World */
10883 "ZZD",
10884 .bg_channels = 13,
10885 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10886 {2427, 4}, {2432, 5}, {2437, 6},
10887 {2442, 7}, {2447, 8}, {2452, 9},
10888 {2457, 10}, {2462, 11}, {2467, 12},
10889 {2472, 13}},
10890 },
10891
10892 { /* Custom USA & Europe & High */
10893 "ZZA",
10894 .bg_channels = 11,
10895 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10896 {2427, 4}, {2432, 5}, {2437, 6},
10897 {2442, 7}, {2447, 8}, {2452, 9},
10898 {2457, 10}, {2462, 11}},
10899 .a_channels = 13,
10900 .a = {{5180, 36},
10901 {5200, 40},
10902 {5220, 44},
10903 {5240, 48},
10904 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10905 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10906 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10907 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10908 {5745, 149},
10909 {5765, 153},
10910 {5785, 157},
10911 {5805, 161},
10912 {5825, 165}},
10913 },
10914
10915 { /* Custom NA & Europe */
10916 "ZZB",
10917 .bg_channels = 11,
10918 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10919 {2427, 4}, {2432, 5}, {2437, 6},
10920 {2442, 7}, {2447, 8}, {2452, 9},
10921 {2457, 10}, {2462, 11}},
10922 .a_channels = 13,
10923 .a = {{5180, 36},
10924 {5200, 40},
10925 {5220, 44},
10926 {5240, 48},
10927 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10928 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10929 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10930 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10931 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
10932 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
10933 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
10934 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
10935 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
10936 },
10937
10938 { /* Custom Japan */
10939 "ZZC",
10940 .bg_channels = 11,
10941 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10942 {2427, 4}, {2432, 5}, {2437, 6},
10943 {2442, 7}, {2447, 8}, {2452, 9},
10944 {2457, 10}, {2462, 11}},
10945 .a_channels = 4,
10946 .a = {{5170, 34}, {5190, 38},
10947 {5210, 42}, {5230, 46}},
10948 },
10949
10950 { /* Custom */
10951 "ZZM",
10952 .bg_channels = 11,
10953 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10954 {2427, 4}, {2432, 5}, {2437, 6},
10955 {2442, 7}, {2447, 8}, {2452, 9},
10956 {2457, 10}, {2462, 11}},
10957 },
10958
10959 { /* Europe */
10960 "ZZE",
10961 .bg_channels = 13,
10962 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10963 {2427, 4}, {2432, 5}, {2437, 6},
10964 {2442, 7}, {2447, 8}, {2452, 9},
10965 {2457, 10}, {2462, 11}, {2467, 12},
10966 {2472, 13}},
10967 .a_channels = 19,
10968 .a = {{5180, 36},
10969 {5200, 40},
10970 {5220, 44},
10971 {5240, 48},
10972 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10973 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10974 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10975 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10976 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
10977 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
10978 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
10979 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
10980 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
10981 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
10982 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
10983 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
10984 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
10985 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
10986 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
10987 },
10988
10989 { /* Custom Japan */
10990 "ZZJ",
10991 .bg_channels = 14,
10992 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10993 {2427, 4}, {2432, 5}, {2437, 6},
10994 {2442, 7}, {2447, 8}, {2452, 9},
10995 {2457, 10}, {2462, 11}, {2467, 12},
10996 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
10997 .a_channels = 4,
10998 .a = {{5170, 34}, {5190, 38},
10999 {5210, 42}, {5230, 46}},
11000 },
11001
James Ketrenos03520572005-10-19 16:12:31 -050011002 { /* Rest of World */
11003 "ZZR",
11004 .bg_channels = 14,
11005 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11006 {2427, 4}, {2432, 5}, {2437, 6},
11007 {2442, 7}, {2447, 8}, {2452, 9},
11008 {2457, 10}, {2462, 11}, {2467, 12},
11009 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11010 IEEE80211_CH_PASSIVE_ONLY}},
11011 },
11012
James Ketrenos4f36f802005-08-03 20:36:56 -050011013 { /* High Band */
11014 "ZZH",
11015 .bg_channels = 13,
11016 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11017 {2427, 4}, {2432, 5}, {2437, 6},
11018 {2442, 7}, {2447, 8}, {2452, 9},
11019 {2457, 10}, {2462, 11},
11020 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11021 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11022 .a_channels = 4,
11023 .a = {{5745, 149}, {5765, 153},
11024 {5785, 157}, {5805, 161}},
11025 },
11026
11027 { /* Custom Europe */
11028 "ZZG",
11029 .bg_channels = 13,
11030 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11031 {2427, 4}, {2432, 5}, {2437, 6},
11032 {2442, 7}, {2447, 8}, {2452, 9},
11033 {2457, 10}, {2462, 11},
11034 {2467, 12}, {2472, 13}},
11035 .a_channels = 4,
11036 .a = {{5180, 36}, {5200, 40},
11037 {5220, 44}, {5240, 48}},
11038 },
11039
11040 { /* Europe */
11041 "ZZK",
11042 .bg_channels = 13,
11043 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11044 {2427, 4}, {2432, 5}, {2437, 6},
11045 {2442, 7}, {2447, 8}, {2452, 9},
11046 {2457, 10}, {2462, 11},
11047 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11048 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11049 .a_channels = 24,
11050 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11051 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11052 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11053 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11054 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11055 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11056 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11057 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11058 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11059 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11060 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11061 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11062 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11063 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11064 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11065 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11066 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11067 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11068 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11069 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11070 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11071 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11072 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11073 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11074 },
11075
11076 { /* Europe */
11077 "ZZL",
11078 .bg_channels = 11,
11079 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11080 {2427, 4}, {2432, 5}, {2437, 6},
11081 {2442, 7}, {2447, 8}, {2452, 9},
11082 {2457, 10}, {2462, 11}},
11083 .a_channels = 13,
11084 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11085 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11086 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11087 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11088 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11089 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11090 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11091 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11092 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11093 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11094 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11095 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11096 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11097 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011098};
11099
James Ketrenos43f66a62005-03-25 12:31:53 -060011100#define MAX_HW_RESTARTS 5
11101static int ipw_up(struct ipw_priv *priv)
11102{
James Ketrenos4f36f802005-08-03 20:36:56 -050011103 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011104
11105 if (priv->status & STATUS_EXIT_PENDING)
11106 return -EIO;
11107
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011108 if (cmdlog && !priv->cmdlog) {
11109 priv->cmdlog = kmalloc(sizeof(*priv->cmdlog) * cmdlog,
11110 GFP_KERNEL);
11111 if (priv->cmdlog == NULL) {
11112 IPW_ERROR("Error allocating %d command log entries.\n",
11113 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011114 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011115 } else {
11116 memset(priv->cmdlog, 0, sizeof(*priv->cmdlog) * cmdlog);
11117 priv->cmdlog_len = cmdlog;
11118 }
11119 }
11120
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011121 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011122 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011123 * Also start the clocks. */
11124 rc = ipw_load(priv);
11125 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011126 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011127 return rc;
11128 }
11129
11130 ipw_init_ordinals(priv);
11131 if (!(priv->config & CFG_CUSTOM_MAC))
11132 eeprom_parse_mac(priv, priv->mac_addr);
11133 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11134
James Ketrenos4f36f802005-08-03 20:36:56 -050011135 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11136 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11137 ipw_geos[j].name, 3))
11138 break;
11139 }
James Ketrenos03520572005-10-19 16:12:31 -050011140 if (j == ARRAY_SIZE(ipw_geos)) {
11141 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11142 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11143 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11144 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011145 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011146 }
Larry Finger1867b112006-02-28 09:48:28 -060011147 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011148 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011149 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011150 }
11151
James Ketrenosb095c382005-08-24 22:04:42 -050011152 if (priv->status & STATUS_RF_KILL_SW) {
11153 IPW_WARNING("Radio disabled by module parameter.\n");
11154 return 0;
11155 } else if (rf_kill_active(priv)) {
11156 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11157 "Kill switch must be turned off for "
11158 "wireless networking to work.\n");
11159 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11160 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011161 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011162 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011163
11164 rc = ipw_config(priv);
11165 if (!rc) {
11166 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011167
James Ketrenose6666192005-08-12 09:17:04 -050011168 /* If configure to try and auto-associate, kick
11169 * off a scan. */
11170 queue_work(priv->workqueue, &priv->request_scan);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011171
James Ketrenos43f66a62005-03-25 12:31:53 -060011172 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011173 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011174
James Ketrenosc848d0a2005-08-24 21:56:24 -050011175 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011176 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11177 i, MAX_HW_RESTARTS);
11178
11179 /* We had an error bringing up the hardware, so take it
11180 * all the way back down so we can try again */
11181 ipw_down(priv);
11182 }
11183
Jeff Garzikbf794512005-07-31 13:07:26 -040011184 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011185 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011186 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011187
James Ketrenos43f66a62005-03-25 12:31:53 -060011188 return -EIO;
11189}
11190
James Ketrenosc848d0a2005-08-24 21:56:24 -050011191static void ipw_bg_up(void *data)
11192{
11193 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080011194 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011195 ipw_up(data);
Zhu Yi46441512006-01-24 16:37:59 +080011196 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011197}
11198
James Ketrenosb095c382005-08-24 22:04:42 -050011199static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011200{
James Ketrenosb095c382005-08-24 22:04:42 -050011201 int i;
11202
11203 if (priv->status & STATUS_SCANNING) {
11204 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11205 ipw_abort_scan(priv);
11206 }
11207
11208 if (priv->status & STATUS_ASSOCIATED) {
11209 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11210 ipw_disassociate(priv);
11211 }
11212
11213 ipw_led_shutdown(priv);
11214
11215 /* Wait up to 1s for status to change to not scanning and not
11216 * associated (disassociation can take a while for a ful 802.11
11217 * exchange */
11218 for (i = 1000; i && (priv->status &
11219 (STATUS_DISASSOCIATING |
11220 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11221 udelay(10);
11222
11223 if (priv->status & (STATUS_DISASSOCIATING |
11224 STATUS_ASSOCIATED | STATUS_SCANNING))
11225 IPW_DEBUG_INFO("Still associated or scanning...\n");
11226 else
11227 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11228
James Ketrenosc848d0a2005-08-24 21:56:24 -050011229 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011230 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011231
11232 priv->status &= ~STATUS_INIT;
11233}
11234
James Ketrenos43f66a62005-03-25 12:31:53 -060011235static void ipw_down(struct ipw_priv *priv)
11236{
James Ketrenosb095c382005-08-24 22:04:42 -050011237 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11238
11239 priv->status |= STATUS_EXIT_PENDING;
11240
11241 if (ipw_is_init(priv))
11242 ipw_deinit(priv);
11243
11244 /* Wipe out the EXIT_PENDING status bit if we are not actually
11245 * exiting the module */
11246 if (!exit_pending)
11247 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011248
11249 /* tell the device to stop sending interrupts */
11250 ipw_disable_interrupts(priv);
11251
11252 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011253 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011254 netif_carrier_off(priv->net_dev);
11255 netif_stop_queue(priv->net_dev);
11256
11257 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011258
11259 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011260}
11261
James Ketrenosc848d0a2005-08-24 21:56:24 -050011262static void ipw_bg_down(void *data)
11263{
11264 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080011265 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011266 ipw_down(data);
Zhu Yi46441512006-01-24 16:37:59 +080011267 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011268}
11269
11270/* Called by register_netdev() */
11271static int ipw_net_init(struct net_device *dev)
11272{
11273 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011274 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011275
James Ketrenosc848d0a2005-08-24 21:56:24 -050011276 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011277 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011278 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011279 }
11280
Zhu Yi46441512006-01-24 16:37:59 +080011281 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011282 return 0;
11283}
11284
11285/* PCI driver stuff */
11286static struct pci_device_id card_ids[] = {
11287 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11288 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11289 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11290 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11291 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11292 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11293 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11294 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11295 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11296 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11297 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11298 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11299 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11300 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11301 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11302 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11303 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11304 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011305 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011306 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011307 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11308 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011309
James Ketrenos43f66a62005-03-25 12:31:53 -060011310 /* required last entry */
11311 {0,}
11312};
11313
11314MODULE_DEVICE_TABLE(pci, card_ids);
11315
11316static struct attribute *ipw_sysfs_entries[] = {
11317 &dev_attr_rf_kill.attr,
11318 &dev_attr_direct_dword.attr,
11319 &dev_attr_indirect_byte.attr,
11320 &dev_attr_indirect_dword.attr,
11321 &dev_attr_mem_gpio_reg.attr,
11322 &dev_attr_command_event_reg.attr,
11323 &dev_attr_nic_type.attr,
11324 &dev_attr_status.attr,
11325 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011326 &dev_attr_error.attr,
11327 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011328 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011329 &dev_attr_eeprom_delay.attr,
11330 &dev_attr_ucode_version.attr,
11331 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011332 &dev_attr_scan_age.attr,
11333 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011334 &dev_attr_speed_scan.attr,
11335 &dev_attr_net_stats.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011336#ifdef CONFIG_IPW2200_PROMISCUOUS
11337 &dev_attr_rtap_iface.attr,
11338 &dev_attr_rtap_filter.attr,
11339#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011340 NULL
11341};
11342
11343static struct attribute_group ipw_attribute_group = {
11344 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011345 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011346};
11347
Zhu Yid685b8c2006-04-13 17:20:27 +080011348#ifdef CONFIG_IPW2200_PROMISCUOUS
11349static int ipw_prom_open(struct net_device *dev)
11350{
11351 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11352 struct ipw_priv *priv = prom_priv->priv;
11353
11354 IPW_DEBUG_INFO("prom dev->open\n");
11355 netif_carrier_off(dev);
11356 netif_stop_queue(dev);
11357
11358 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11359 priv->sys_config.accept_all_data_frames = 1;
11360 priv->sys_config.accept_non_directed_frames = 1;
11361 priv->sys_config.accept_all_mgmt_bcpr = 1;
11362 priv->sys_config.accept_all_mgmt_frames = 1;
11363
11364 ipw_send_system_config(priv);
11365 }
11366
11367 return 0;
11368}
11369
11370static int ipw_prom_stop(struct net_device *dev)
11371{
11372 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11373 struct ipw_priv *priv = prom_priv->priv;
11374
11375 IPW_DEBUG_INFO("prom dev->stop\n");
11376
11377 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11378 priv->sys_config.accept_all_data_frames = 0;
11379 priv->sys_config.accept_non_directed_frames = 0;
11380 priv->sys_config.accept_all_mgmt_bcpr = 0;
11381 priv->sys_config.accept_all_mgmt_frames = 0;
11382
11383 ipw_send_system_config(priv);
11384 }
11385
11386 return 0;
11387}
11388
11389static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11390{
11391 IPW_DEBUG_INFO("prom dev->xmit\n");
11392 netif_stop_queue(dev);
11393 return -EOPNOTSUPP;
11394}
11395
11396static struct net_device_stats *ipw_prom_get_stats(struct net_device *dev)
11397{
11398 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11399 return &prom_priv->ieee->stats;
11400}
11401
11402static int ipw_prom_alloc(struct ipw_priv *priv)
11403{
11404 int rc = 0;
11405
11406 if (priv->prom_net_dev)
11407 return -EPERM;
11408
11409 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11410 if (priv->prom_net_dev == NULL)
11411 return -ENOMEM;
11412
11413 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11414 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11415 priv->prom_priv->priv = priv;
11416
11417 strcpy(priv->prom_net_dev->name, "rtap%d");
11418
11419 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
11420 priv->prom_net_dev->open = ipw_prom_open;
11421 priv->prom_net_dev->stop = ipw_prom_stop;
11422 priv->prom_net_dev->get_stats = ipw_prom_get_stats;
11423 priv->prom_net_dev->hard_start_xmit = ipw_prom_hard_start_xmit;
11424
11425 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
11426
11427 rc = register_netdev(priv->prom_net_dev);
11428 if (rc) {
11429 free_ieee80211(priv->prom_net_dev);
11430 priv->prom_net_dev = NULL;
11431 return rc;
11432 }
11433
11434 return 0;
11435}
11436
11437static void ipw_prom_free(struct ipw_priv *priv)
11438{
11439 if (!priv->prom_net_dev)
11440 return;
11441
11442 unregister_netdev(priv->prom_net_dev);
11443 free_ieee80211(priv->prom_net_dev);
11444
11445 priv->prom_net_dev = NULL;
11446}
11447
11448#endif
11449
11450
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011451static int ipw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011452{
11453 int err = 0;
11454 struct net_device *net_dev;
11455 void __iomem *base;
11456 u32 length, val;
11457 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011458 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011459
11460 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11461 if (net_dev == NULL) {
11462 err = -ENOMEM;
11463 goto out;
11464 }
11465
11466 priv = ieee80211_priv(net_dev);
11467 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011468
James Ketrenos43f66a62005-03-25 12:31:53 -060011469 priv->net_dev = net_dev;
11470 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011471 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011472 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011473 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011474 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11475 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011476
Zhu Yi46441512006-01-24 16:37:59 +080011477 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011478 if (pci_enable_device(pdev)) {
11479 err = -ENODEV;
11480 goto out_free_ieee80211;
11481 }
11482
11483 pci_set_master(pdev);
11484
Tobias Klauser0e08b442005-06-20 14:28:41 -070011485 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011486 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011487 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011488 if (err) {
11489 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11490 goto out_pci_disable_device;
11491 }
11492
11493 pci_set_drvdata(pdev, priv);
11494
11495 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011496 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011497 goto out_pci_disable_device;
11498
Jeff Garzikbf794512005-07-31 13:07:26 -040011499 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011500 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011501 pci_read_config_dword(pdev, 0x40, &val);
11502 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011503 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011504
James Ketrenos43f66a62005-03-25 12:31:53 -060011505 length = pci_resource_len(pdev, 0);
11506 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011507
James Ketrenos43f66a62005-03-25 12:31:53 -060011508 base = ioremap_nocache(pci_resource_start(pdev, 0), length);
11509 if (!base) {
11510 err = -ENODEV;
11511 goto out_pci_release_regions;
11512 }
11513
11514 priv->hw_base = base;
11515 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11516 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11517
11518 err = ipw_setup_deferred_work(priv);
11519 if (err) {
11520 IPW_ERROR("Unable to setup deferred work\n");
11521 goto out_iounmap;
11522 }
11523
James Ketrenosb095c382005-08-24 22:04:42 -050011524 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011525
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011526 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011527 if (err) {
11528 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11529 goto out_destroy_workqueue;
11530 }
11531
11532 SET_MODULE_OWNER(net_dev);
11533 SET_NETDEV_DEV(net_dev, &pdev->dev);
11534
Zhu Yi46441512006-01-24 16:37:59 +080011535 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011536
James Ketrenos43f66a62005-03-25 12:31:53 -060011537 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11538 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011539 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011540
Zhu Yie43e3c12006-04-13 17:20:45 +080011541#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011542 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011543 priv->ieee->handle_probe_response = ipw_handle_beacon;
11544 priv->ieee->handle_beacon = ipw_handle_probe_response;
11545 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011546#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011547
James Ketrenosc848d0a2005-08-24 21:56:24 -050011548 priv->ieee->perfect_rssi = -20;
11549 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011550
11551 net_dev->open = ipw_net_open;
11552 net_dev->stop = ipw_net_stop;
11553 net_dev->init = ipw_net_init;
11554 net_dev->get_stats = ipw_net_get_stats;
11555 net_dev->set_multicast_list = ipw_net_set_multicast_list;
11556 net_dev->set_mac_address = ipw_net_set_mac_address;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011557 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011558 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011559 net_dev->wireless_handlers = &ipw_wx_handler_def;
11560 net_dev->ethtool_ops = &ipw_ethtool_ops;
11561 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011562 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011563 net_dev->mem_start = pci_resource_start(pdev, 0);
11564 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11565
11566 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11567 if (err) {
11568 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011569 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011570 goto out_release_irq;
11571 }
11572
Zhu Yi46441512006-01-24 16:37:59 +080011573 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011574 err = register_netdev(net_dev);
11575 if (err) {
11576 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011577 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011578 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011579
Zhu Yid685b8c2006-04-13 17:20:27 +080011580#ifdef CONFIG_IPW2200_PROMISCUOUS
11581 if (rtap_iface) {
11582 err = ipw_prom_alloc(priv);
11583 if (err) {
11584 IPW_ERROR("Failed to register promiscuous network "
11585 "device (error %d).\n", err);
11586 unregister_netdev(priv->net_dev);
11587 goto out_remove_sysfs;
11588 }
11589 }
11590#endif
11591
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011592 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11593 "channels, %d 802.11a channels)\n",
11594 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11595 priv->ieee->geo.a_channels);
11596
James Ketrenos43f66a62005-03-25 12:31:53 -060011597 return 0;
11598
James Ketrenosa613bff2005-08-24 21:43:11 -050011599 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011600 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011601 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011602 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011603 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011604 destroy_workqueue(priv->workqueue);
11605 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011606 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011607 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011608 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011609 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011610 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011611 pci_disable_device(pdev);
11612 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011613 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011614 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011615 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011616 return err;
11617}
11618
11619static void ipw_pci_remove(struct pci_dev *pdev)
11620{
11621 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011622 struct list_head *p, *q;
11623 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011624
James Ketrenos43f66a62005-03-25 12:31:53 -060011625 if (!priv)
11626 return;
11627
Zhu Yi46441512006-01-24 16:37:59 +080011628 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011629
James Ketrenosafbf30a2005-08-25 00:05:33 -050011630 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011631 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011632 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11633
Zhu Yi46441512006-01-24 16:37:59 +080011634 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011635
11636 unregister_netdev(priv->net_dev);
11637
11638 if (priv->rxq) {
11639 ipw_rx_queue_free(priv, priv->rxq);
11640 priv->rxq = NULL;
11641 }
11642 ipw_tx_queue_free(priv);
11643
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011644 if (priv->cmdlog) {
11645 kfree(priv->cmdlog);
11646 priv->cmdlog = NULL;
11647 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011648 /* ipw_down will ensure that there is no more pending work
11649 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011650 cancel_delayed_work(&priv->adhoc_check);
11651 cancel_delayed_work(&priv->gather_stats);
11652 cancel_delayed_work(&priv->request_scan);
11653 cancel_delayed_work(&priv->rf_kill);
11654 cancel_delayed_work(&priv->scan_check);
11655 destroy_workqueue(priv->workqueue);
11656 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011657
James Ketrenosafbf30a2005-08-25 00:05:33 -050011658 /* Free MAC hash list for ADHOC */
11659 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11660 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011661 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011662 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011663 }
11664 }
11665
Jesper Juhl8f760782006-06-27 02:55:06 -070011666 kfree(priv->error);
11667 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011668
Zhu Yid685b8c2006-04-13 17:20:27 +080011669#ifdef CONFIG_IPW2200_PROMISCUOUS
11670 ipw_prom_free(priv);
11671#endif
11672
James Ketrenos43f66a62005-03-25 12:31:53 -060011673 free_irq(pdev->irq, priv);
11674 iounmap(priv->hw_base);
11675 pci_release_regions(pdev);
11676 pci_disable_device(pdev);
11677 pci_set_drvdata(pdev, NULL);
11678 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011679 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011680}
11681
James Ketrenos43f66a62005-03-25 12:31:53 -060011682#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011683static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011684{
11685 struct ipw_priv *priv = pci_get_drvdata(pdev);
11686 struct net_device *dev = priv->net_dev;
11687
11688 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11689
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011690 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011691 ipw_down(priv);
11692
11693 /* Remove the PRESENT state of the device */
11694 netif_device_detach(dev);
11695
James Ketrenos43f66a62005-03-25 12:31:53 -060011696 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011697 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011698 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011699
James Ketrenos43f66a62005-03-25 12:31:53 -060011700 return 0;
11701}
11702
11703static int ipw_pci_resume(struct pci_dev *pdev)
11704{
11705 struct ipw_priv *priv = pci_get_drvdata(pdev);
11706 struct net_device *dev = priv->net_dev;
11707 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011708
James Ketrenos43f66a62005-03-25 12:31:53 -060011709 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11710
James Ketrenosea2b26e2005-08-24 21:25:16 -050011711 pci_set_power_state(pdev, PCI_D0);
James Ketrenos43f66a62005-03-25 12:31:53 -060011712 pci_enable_device(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011713 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011714
James Ketrenos43f66a62005-03-25 12:31:53 -060011715 /*
11716 * Suspend/Resume resets the PCI configuration space, so we have to
11717 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11718 * from interfering with C3 CPU state. pci_restore_state won't help
11719 * here since it only restores the first 64 bytes pci config header.
11720 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011721 pci_read_config_dword(pdev, 0x40, &val);
11722 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011723 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11724
11725 /* Set the device back into the PRESENT state; this will also wake
11726 * the queue of needed */
11727 netif_device_attach(dev);
11728
11729 /* Bring the device back up */
11730 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011731
James Ketrenos43f66a62005-03-25 12:31:53 -060011732 return 0;
11733}
11734#endif
11735
11736/* driver initialization stuff */
11737static struct pci_driver ipw_driver = {
11738 .name = DRV_NAME,
11739 .id_table = card_ids,
11740 .probe = ipw_pci_probe,
11741 .remove = __devexit_p(ipw_pci_remove),
11742#ifdef CONFIG_PM
11743 .suspend = ipw_pci_suspend,
11744 .resume = ipw_pci_resume,
11745#endif
11746};
11747
11748static int __init ipw_init(void)
11749{
11750 int ret;
11751
11752 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11753 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11754
11755 ret = pci_module_init(&ipw_driver);
11756 if (ret) {
11757 IPW_ERROR("Unable to initialize PCI module\n");
11758 return ret;
11759 }
11760
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011761 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011762 if (ret) {
11763 IPW_ERROR("Unable to create driver sysfs file\n");
11764 pci_unregister_driver(&ipw_driver);
11765 return ret;
11766 }
11767
11768 return ret;
11769}
11770
11771static void __exit ipw_exit(void)
11772{
11773 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11774 pci_unregister_driver(&ipw_driver);
11775}
11776
11777module_param(disable, int, 0444);
11778MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11779
11780module_param(associate, int, 0444);
11781MODULE_PARM_DESC(associate, "auto associate when scanning (default on)");
11782
11783module_param(auto_create, int, 0444);
11784MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11785
James Ketrenosa613bff2005-08-24 21:43:11 -050011786module_param(led, int, 0444);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011787MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011788
Zhu Yi3e1555b2006-03-06 05:48:37 +080011789#ifdef CONFIG_IPW2200_DEBUG
James Ketrenos43f66a62005-03-25 12:31:53 -060011790module_param(debug, int, 0444);
11791MODULE_PARM_DESC(debug, "debug output mask");
Zhu Yi3e1555b2006-03-06 05:48:37 +080011792#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011793
11794module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011795MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011796
Zhu Yid685b8c2006-04-13 17:20:27 +080011797#ifdef CONFIG_IPW2200_PROMISCUOUS
11798module_param(rtap_iface, int, 0444);
11799MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11800#endif
11801
Zhu Yie43e3c12006-04-13 17:20:45 +080011802#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011803module_param(qos_enable, int, 0444);
11804MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011805
James Ketrenosb095c382005-08-24 22:04:42 -050011806module_param(qos_burst_enable, int, 0444);
11807MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11808
11809module_param(qos_no_ack_mask, int, 0444);
11810MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11811
11812module_param(burst_duration_CCK, int, 0444);
11813MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11814
11815module_param(burst_duration_OFDM, int, 0444);
11816MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011817#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011818
11819#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060011820module_param(mode, int, 0444);
11821MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
11822#else
11823module_param(mode, int, 0444);
11824MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
11825#endif
11826
Zhu Yi810dabd2006-01-24 16:36:59 +080011827module_param(bt_coexist, int, 0444);
11828MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
11829
James Ketrenosb095c382005-08-24 22:04:42 -050011830module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080011831MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050011832
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011833module_param(cmdlog, int, 0444);
11834MODULE_PARM_DESC(cmdlog,
11835 "allocate a ring buffer for logging firmware commands");
11836
Zhu Yi4bfdb912006-01-24 16:37:16 +080011837module_param(roaming, int, 0444);
11838MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
11839
Zhu Yid2b83e12006-04-13 17:19:36 +080011840module_param(antenna, int, 0444);
11841MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
11842
James Ketrenos43f66a62005-03-25 12:31:53 -060011843module_exit(ipw_exit);
11844module_init(ipw_init);