blob: aa32a97380ecb664152fab018552f561d7a71aa5 [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 Yiaac40ce2006-12-05 14:41:24 +080073#define IPW2200_VERSION "1.2.0" VK VD VM VP VR VQ
James Ketrenos43f66a62005-03-25 12:31:53 -060074#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2200/2915 Network Driver"
Zhu Yi171e7b22006-02-15 07:17:56 +080075#define DRV_COPYRIGHT "Copyright(c) 2003-2006 Intel Corporation"
James Ketrenos43f66a62005-03-25 12:31:53 -060076#define DRV_VERSION IPW2200_VERSION
77
James Ketrenosb095c382005-08-24 22:04:42 -050078#define ETH_P_80211_STATS (ETH_P_80211_RAW + 1)
79
James Ketrenos43f66a62005-03-25 12:31:53 -060080MODULE_DESCRIPTION(DRV_DESCRIPTION);
81MODULE_VERSION(DRV_VERSION);
82MODULE_AUTHOR(DRV_COPYRIGHT);
83MODULE_LICENSE("GPL");
84
James Ketrenosf6c5cb72005-08-25 00:39:09 -050085static int cmdlog = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060086static int debug = 0;
87static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060088static int mode = 0;
89
90static u32 ipw_debug_level;
91static int associate = 1;
92static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050093static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060094static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080095static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080096static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080097static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -060098static const char ipw_modes[] = {
99 'a', 'b', 'g', '?'
100};
Zhu Yid2b83e12006-04-13 17:19:36 +0800101static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600102
Zhu Yid685b8c2006-04-13 17:20:27 +0800103#ifdef CONFIG_IPW2200_PROMISCUOUS
104static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
105#endif
106
107
Zhu Yie43e3c12006-04-13 17:20:45 +0800108#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500109static int qos_enable = 0;
110static int qos_burst_enable = 0;
111static int qos_no_ack_mask = 0;
112static int burst_duration_CCK = 0;
113static int burst_duration_OFDM = 0;
114
115static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
116 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
117 QOS_TX3_CW_MIN_OFDM},
118 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
119 QOS_TX3_CW_MAX_OFDM},
120 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
121 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
122 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
123 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
124};
125
126static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
127 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
128 QOS_TX3_CW_MIN_CCK},
129 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
130 QOS_TX3_CW_MAX_CCK},
131 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
132 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
133 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
134 QOS_TX3_TXOP_LIMIT_CCK}
135};
136
137static struct ieee80211_qos_parameters def_parameters_OFDM = {
138 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
139 DEF_TX3_CW_MIN_OFDM},
140 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
141 DEF_TX3_CW_MAX_OFDM},
142 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
143 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
144 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
145 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
146};
147
148static struct ieee80211_qos_parameters def_parameters_CCK = {
149 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
150 DEF_TX3_CW_MIN_CCK},
151 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
152 DEF_TX3_CW_MAX_CCK},
153 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
154 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
155 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
156 DEF_TX3_TXOP_LIMIT_CCK}
157};
158
159static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
160
161static int from_priority_to_tx_queue[] = {
162 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
163 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
164};
165
166static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
167
168static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
169 *qos_param);
170static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
171 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800172#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500173
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000174static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500175static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600176static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400177static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600178 struct clx2_tx_queue *txq, int qindex);
179static int ipw_queue_reset(struct ipw_priv *priv);
180
181static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
182 int len, int sync);
183
184static void ipw_tx_queue_free(struct ipw_priv *);
185
186static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
187static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
188static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600189static int ipw_up(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000190static void ipw_bg_up(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600191static void ipw_down(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000192static void ipw_bg_down(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600193static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400194static int init_supported_rates(struct ipw_priv *priv,
195 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500196static void ipw_set_hwcrypto_keys(struct ipw_priv *);
197static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600198
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500199static int snprint_line(char *buf, size_t count,
200 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600201{
202 int out, i, j, l;
203 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400204
James Ketrenos43f66a62005-03-25 12:31:53 -0600205 out = snprintf(buf, count, "%08X", ofs);
206
207 for (l = 0, i = 0; i < 2; i++) {
208 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400209 for (j = 0; j < 8 && l < len; j++, l++)
210 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600211 data[(i * 8 + j)]);
212 for (; j < 8; j++)
213 out += snprintf(buf + out, count - out, " ");
214 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400215
James Ketrenos43f66a62005-03-25 12:31:53 -0600216 out += snprintf(buf + out, count - out, " ");
217 for (l = 0, i = 0; i < 2; i++) {
218 out += snprintf(buf + out, count - out, " ");
219 for (j = 0; j < 8 && l < len; j++, l++) {
220 c = data[(i * 8 + j)];
221 if (!isascii(c) || !isprint(c))
222 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400223
James Ketrenos43f66a62005-03-25 12:31:53 -0600224 out += snprintf(buf + out, count - out, "%c", c);
225 }
226
227 for (; j < 8; j++)
228 out += snprintf(buf + out, count - out, " ");
229 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400230
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500231 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600232}
233
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400234static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600235{
236 char line[81];
237 u32 ofs = 0;
238 if (!(ipw_debug_level & level))
239 return;
240
241 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500242 snprint_line(line, sizeof(line), &data[ofs],
243 min(len, 16U), ofs);
244 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600245 ofs += 16;
246 len -= min(len, 16U);
247 }
248}
249
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500250static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
251{
252 size_t out = size;
253 u32 ofs = 0;
254 int total = 0;
255
256 while (size && len) {
257 out = snprint_line(output, size, &data[ofs],
258 min_t(size_t, len, 16U), ofs);
259
260 ofs += 16;
261 output += out;
262 size -= out;
263 len -= min_t(size_t, len, 16U);
264 total += out;
265 }
266 return total;
267}
268
Zhu Yic8fe6672006-01-24 16:36:36 +0800269/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600270static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
271#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
272
Zhu Yic8fe6672006-01-24 16:36:36 +0800273/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600274static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
275#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
276
Zhu Yic8fe6672006-01-24 16:36:36 +0800277/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600278static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
279static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
280{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400281 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
282 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600283 _ipw_write_reg8(a, b, c);
284}
285
Zhu Yic8fe6672006-01-24 16:36:36 +0800286/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600287static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
288static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
289{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400290 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
291 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600292 _ipw_write_reg16(a, b, c);
293}
294
Zhu Yic8fe6672006-01-24 16:36:36 +0800295/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600296static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
297static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
298{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400299 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
300 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600301 _ipw_write_reg32(a, b, c);
302}
303
Zhu Yic8fe6672006-01-24 16:36:36 +0800304/* 8-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600305#define _ipw_write8(ipw, ofs, val) writeb((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800306
307/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600308#define ipw_write8(ipw, ofs, val) \
309 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
310 _ipw_write8(ipw, ofs, val)
311
Zhu Yic8fe6672006-01-24 16:36:36 +0800312/* 16-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600313#define _ipw_write16(ipw, ofs, val) writew((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800314
315/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600316#define ipw_write16(ipw, ofs, val) \
317 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
318 _ipw_write16(ipw, ofs, val)
319
Zhu Yic8fe6672006-01-24 16:36:36 +0800320/* 32-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600321#define _ipw_write32(ipw, ofs, val) writel((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800322
323/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600324#define ipw_write32(ipw, ofs, val) \
325 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
326 _ipw_write32(ipw, ofs, val)
327
Zhu Yic8fe6672006-01-24 16:36:36 +0800328/* 8-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600329#define _ipw_read8(ipw, ofs) readb((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800330
331/* 8-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400332static inline u8 __ipw_read8(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
333{
334 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600335 return _ipw_read8(ipw, ofs);
336}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400337
Zhu Yic8fe6672006-01-24 16:36:36 +0800338/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600339#define ipw_read8(ipw, ofs) __ipw_read8(__FILE__, __LINE__, ipw, ofs)
340
Zhu Yic8fe6672006-01-24 16:36:36 +0800341/* 16-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600342#define _ipw_read16(ipw, ofs) readw((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800343
344/* 16-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400345static inline u16 __ipw_read16(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
346{
347 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600348 return _ipw_read16(ipw, ofs);
349}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400350
Zhu Yic8fe6672006-01-24 16:36:36 +0800351/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600352#define ipw_read16(ipw, ofs) __ipw_read16(__FILE__, __LINE__, ipw, ofs)
353
Zhu Yic8fe6672006-01-24 16:36:36 +0800354/* 32-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600355#define _ipw_read32(ipw, ofs) readl((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800356
357/* 32-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400358static inline u32 __ipw_read32(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
359{
360 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600361 return _ipw_read32(ipw, ofs);
362}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400363
Zhu Yic8fe6672006-01-24 16:36:36 +0800364/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600365#define ipw_read32(ipw, ofs) __ipw_read32(__FILE__, __LINE__, ipw, ofs)
366
Zhu Yic8fe6672006-01-24 16:36:36 +0800367/* multi-byte read (above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600368static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500369static inline void __ipw_read_indirect(const char *f, int l,
370 struct ipw_priv *a, u32 b, u8 * c, int d)
371{
372 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %d bytes\n", f, l, (u32) (b),
373 d);
374 _ipw_read_indirect(a, b, c, d);
375}
376
Zhu Yic8fe6672006-01-24 16:36:36 +0800377/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500378#define ipw_read_indirect(a, b, c, d) __ipw_read_indirect(__FILE__, __LINE__, a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600379
Zhu Yic8fe6672006-01-24 16:36:36 +0800380/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400381static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
382 int num);
James Ketrenos43f66a62005-03-25 12:31:53 -0600383#define ipw_write_indirect(a, b, c, d) \
384 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %d bytes\n", __FILE__, __LINE__, (u32)(b), d); \
James Ketrenosafbf30a2005-08-25 00:05:33 -0500385 _ipw_write_indirect(a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600386
Zhu Yic8fe6672006-01-24 16:36:36 +0800387/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400388static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600389{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400390 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500391 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
392 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600393}
394
Zhu Yic8fe6672006-01-24 16:36:36 +0800395/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600396static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
397{
Zhu Yi2638bc32006-01-24 16:37:52 +0800398 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800399 u32 dif_len = reg - aligned_addr;
400
James Ketrenos43f66a62005-03-25 12:31:53 -0600401 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800402 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
403 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600404}
405
Zhu Yic8fe6672006-01-24 16:36:36 +0800406/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400407static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600408{
Zhu Yi2638bc32006-01-24 16:37:52 +0800409 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800410 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
411
James Ketrenos43f66a62005-03-25 12:31:53 -0600412 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800413 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
414 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600415}
416
Zhu Yic8fe6672006-01-24 16:36:36 +0800417/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600418static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
419{
420 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500421 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600422 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500423 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400424 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600425}
426
Zhu Yic8fe6672006-01-24 16:36:36 +0800427/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600428static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
429{
430 u32 value;
431
432 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
433
James Ketrenosb095c382005-08-24 22:04:42 -0500434 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
435 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600436 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
437 return value;
438}
439
Zhu Yic8fe6672006-01-24 16:36:36 +0800440/* General purpose, no alignment requirement, iterative (multi-byte) read, */
441/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600442static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
443 int num)
444{
Zhu Yi2638bc32006-01-24 16:37:52 +0800445 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600446 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600447 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400448
James Ketrenos43f66a62005-03-25 12:31:53 -0600449 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
450
James Ketrenosea2b26e2005-08-24 21:25:16 -0500451 if (num <= 0) {
452 return;
453 }
454
Zhu Yic8fe6672006-01-24 16:36:36 +0800455 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600456 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500457 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600458 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500459 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500460 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600461 aligned_addr += 4;
462 }
463
Zhu Yic8fe6672006-01-24 16:36:36 +0800464 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500465 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500466 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500467 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400468
Zhu Yic8fe6672006-01-24 16:36:36 +0800469 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500470 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500471 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500472 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500473 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500474 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600475}
476
Zhu Yic8fe6672006-01-24 16:36:36 +0800477/* General purpose, no alignment requirement, iterative (multi-byte) write, */
478/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400479static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600480 int num)
481{
Zhu Yi2638bc32006-01-24 16:37:52 +0800482 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600483 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600484 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400485
James Ketrenos43f66a62005-03-25 12:31:53 -0600486 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400487
James Ketrenosea2b26e2005-08-24 21:25:16 -0500488 if (num <= 0) {
489 return;
490 }
491
Zhu Yic8fe6672006-01-24 16:36:36 +0800492 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600493 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500494 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800495 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500496 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500497 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600498 aligned_addr += 4;
499 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400500
Zhu Yic8fe6672006-01-24 16:36:36 +0800501 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500502 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500503 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500504 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400505
Zhu Yic8fe6672006-01-24 16:36:36 +0800506 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500507 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500508 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500509 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500510 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500511 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600512}
513
Zhu Yic8fe6672006-01-24 16:36:36 +0800514/* General purpose, no alignment requirement, iterative (multi-byte) write, */
515/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400516static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600517 int num)
518{
519 memcpy_toio((priv->hw_base + addr), buf, num);
520}
521
Zhu Yic8fe6672006-01-24 16:36:36 +0800522/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600523static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
524{
525 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
526}
527
Zhu Yic8fe6672006-01-24 16:36:36 +0800528/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600529static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
530{
531 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
532}
533
Zhu Yi89c318e2006-06-08 22:19:49 -0700534static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600535{
536 if (priv->status & STATUS_INT_ENABLED)
537 return;
538 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500539 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600540}
541
Zhu Yi89c318e2006-06-08 22:19:49 -0700542static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600543{
544 if (!(priv->status & STATUS_INT_ENABLED))
545 return;
546 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500547 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600548}
549
Zhu Yi89c318e2006-06-08 22:19:49 -0700550static inline void ipw_enable_interrupts(struct ipw_priv *priv)
551{
552 unsigned long flags;
553
554 spin_lock_irqsave(&priv->irq_lock, flags);
555 __ipw_enable_interrupts(priv);
556 spin_unlock_irqrestore(&priv->irq_lock, flags);
557}
558
559static inline void ipw_disable_interrupts(struct ipw_priv *priv)
560{
561 unsigned long flags;
562
563 spin_lock_irqsave(&priv->irq_lock, flags);
564 __ipw_disable_interrupts(priv);
565 spin_unlock_irqrestore(&priv->irq_lock, flags);
566}
567
James Ketrenos43f66a62005-03-25 12:31:53 -0600568static char *ipw_error_desc(u32 val)
569{
570 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400571 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600572 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400573 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600574 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400575 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600576 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400577 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600578 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400579 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500580 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400581 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500582 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400583 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500584 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500586 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500588 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500590 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500592 return "DMA_STATUS";
593 case IPW_FW_ERROR_DINO_ERROR:
594 return "DINO_ERROR";
595 case IPW_FW_ERROR_EEPROM_ERROR:
596 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400597 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500598 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600603 }
604}
605
James Ketrenosb39860c2005-08-12 09:36:32 -0500606static void ipw_dump_error_log(struct ipw_priv *priv,
607 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600608{
James Ketrenosb39860c2005-08-12 09:36:32 -0500609 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600610
James Ketrenosb39860c2005-08-12 09:36:32 -0500611 if (!error) {
612 IPW_ERROR("Error allocating and capturing error log. "
613 "Nothing to dump.\n");
614 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600615 }
616
James Ketrenosb39860c2005-08-12 09:36:32 -0500617 IPW_ERROR("Start IPW Error Log Dump:\n");
618 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
619 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600620
James Ketrenosb39860c2005-08-12 09:36:32 -0500621 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400622 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 ipw_error_desc(error->elem[i].desc),
624 error->elem[i].time,
625 error->elem[i].blink1,
626 error->elem[i].blink2,
627 error->elem[i].link1,
628 error->elem[i].link2, error->elem[i].data);
629 for (i = 0; i < error->log_len; i++)
630 IPW_ERROR("%i\t0x%08x\t%i\n",
631 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500632 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600633}
James Ketrenos43f66a62005-03-25 12:31:53 -0600634
James Ketrenosc848d0a2005-08-24 21:56:24 -0500635static inline int ipw_is_init(struct ipw_priv *priv)
636{
637 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600638}
639
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400640static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600641{
642 u32 addr, field_info, field_len, field_count, total_len;
643
644 IPW_DEBUG_ORD("ordinal = %i\n", ord);
645
646 if (!priv || !val || !len) {
647 IPW_DEBUG_ORD("Invalid argument\n");
648 return -EINVAL;
649 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400650
James Ketrenos43f66a62005-03-25 12:31:53 -0600651 /* verify device ordinal tables have been initialized */
652 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
653 IPW_DEBUG_ORD("Access ordinals before initialization\n");
654 return -EINVAL;
655 }
656
657 switch (IPW_ORD_TABLE_ID_MASK & ord) {
658 case IPW_ORD_TABLE_0_MASK:
659 /*
660 * TABLE 0: Direct access to a table of 32 bit values
661 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400662 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600663 * read from the table
664 */
665
666 /* remove the table id from the ordinal */
667 ord &= IPW_ORD_TABLE_VALUE_MASK;
668
669 /* boundary check */
670 if (ord > priv->table0_len) {
671 IPW_DEBUG_ORD("ordinal value (%i) longer then "
672 "max (%i)\n", ord, priv->table0_len);
673 return -EINVAL;
674 }
675
676 /* verify we have enough room to store the value */
677 if (*len < sizeof(u32)) {
678 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200679 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600680 return -EINVAL;
681 }
682
683 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400684 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600685
686 *len = sizeof(u32);
687 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400688 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600689 break;
690
691 case IPW_ORD_TABLE_1_MASK:
692 /*
693 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400694 *
695 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600696 * representing starting addr for the data (which is
697 * also a u32)
698 */
699
700 /* remove the table id from the ordinal */
701 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400702
James Ketrenos43f66a62005-03-25 12:31:53 -0600703 /* boundary check */
704 if (ord > priv->table1_len) {
705 IPW_DEBUG_ORD("ordinal value too long\n");
706 return -EINVAL;
707 }
708
709 /* verify we have enough room to store the value */
710 if (*len < sizeof(u32)) {
711 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200712 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600713 return -EINVAL;
714 }
715
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400716 *((u32 *) val) =
717 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600718 *len = sizeof(u32);
719 break;
720
721 case IPW_ORD_TABLE_2_MASK:
722 /*
723 * TABLE 2: Indirect access to a table of variable sized values
724 *
725 * This table consist of six values, each containing
726 * - dword containing the starting offset of the data
727 * - dword containing the lengh in the first 16bits
728 * and the count in the second 16bits
729 */
730
731 /* remove the table id from the ordinal */
732 ord &= IPW_ORD_TABLE_VALUE_MASK;
733
734 /* boundary check */
735 if (ord > priv->table2_len) {
736 IPW_DEBUG_ORD("ordinal value too long\n");
737 return -EINVAL;
738 }
739
740 /* get the address of statistic */
741 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400742
743 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600744 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400745 field_info =
746 ipw_read_reg32(priv,
747 priv->table2_addr + (ord << 3) +
748 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400749
James Ketrenos43f66a62005-03-25 12:31:53 -0600750 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400751 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400752
James Ketrenos43f66a62005-03-25 12:31:53 -0600753 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400754 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400755
James Ketrenos43f66a62005-03-25 12:31:53 -0600756 /* abort if not enought memory */
757 total_len = field_len * field_count;
758 if (total_len > *len) {
759 *len = total_len;
760 return -EINVAL;
761 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400762
James Ketrenos43f66a62005-03-25 12:31:53 -0600763 *len = total_len;
764 if (!total_len)
765 return 0;
766
767 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400768 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600769 addr, total_len, field_info);
770 ipw_read_indirect(priv, addr, val, total_len);
771 break;
772
773 default:
774 IPW_DEBUG_ORD("Invalid ordinal!\n");
775 return -EINVAL;
776
777 }
778
James Ketrenos43f66a62005-03-25 12:31:53 -0600779 return 0;
780}
781
782static void ipw_init_ordinals(struct ipw_priv *priv)
783{
784 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400785 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600786
787 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
788 priv->table0_addr, priv->table0_len);
789
790 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
791 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
792
793 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
794 priv->table1_addr, priv->table1_len);
795
796 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
797 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400798 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600799
800 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
801 priv->table2_addr, priv->table2_len);
802
803}
804
Adrian Bunka73e22b2006-01-21 01:39:42 +0100805static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500806{
James Ketrenosb095c382005-08-24 22:04:42 -0500807 reg &= ~IPW_START_STANDBY;
808 if (reg & IPW_GATE_ODMA)
809 reg &= ~IPW_GATE_ODMA;
810 if (reg & IPW_GATE_IDMA)
811 reg &= ~IPW_GATE_IDMA;
812 if (reg & IPW_GATE_ADMA)
813 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500814 return reg;
815}
816
817/*
818 * LED behavior:
819 * - On radio ON, turn on any LEDs that require to be on during start
820 * - On initialization, start unassociated blink
821 * - On association, disable unassociated blink
822 * - On disassociation, start unassociated blink
823 * - On radio OFF, turn off any LEDs started during radio on
824 *
825 */
Zhu Yiede61112006-01-24 16:37:10 +0800826#define LD_TIME_LINK_ON msecs_to_jiffies(300)
827#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
828#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500829
Adrian Bunka73e22b2006-01-21 01:39:42 +0100830static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500831{
832 unsigned long flags;
833 u32 led;
834
835 /* If configured to not use LEDs, or nic_type is 1,
836 * then we don't toggle a LINK led */
837 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
838 return;
839
840 spin_lock_irqsave(&priv->lock, flags);
841
842 if (!(priv->status & STATUS_RF_KILL_MASK) &&
843 !(priv->status & STATUS_LED_LINK_ON)) {
844 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500845 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500846 led |= priv->led_association_on;
847
848 led = ipw_register_toggle(led);
849
850 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500851 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500852
853 priv->status |= STATUS_LED_LINK_ON;
854
855 /* If we aren't associated, schedule turning the LED off */
856 if (!(priv->status & STATUS_ASSOCIATED))
857 queue_delayed_work(priv->workqueue,
858 &priv->led_link_off,
859 LD_TIME_LINK_ON);
860 }
861
862 spin_unlock_irqrestore(&priv->lock, flags);
863}
864
David Howellsc4028952006-11-22 14:57:56 +0000865static void ipw_bg_led_link_on(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500866{
David Howellsc4028952006-11-22 14:57:56 +0000867 struct ipw_priv *priv =
868 container_of(work, struct ipw_priv, led_link_on.work);
Zhu Yi46441512006-01-24 16:37:59 +0800869 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000870 ipw_led_link_on(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800871 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500872}
873
Adrian Bunka73e22b2006-01-21 01:39:42 +0100874static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500875{
876 unsigned long flags;
877 u32 led;
878
879 /* If configured not to use LEDs, or nic type is 1,
880 * then we don't goggle the LINK led. */
881 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
882 return;
883
884 spin_lock_irqsave(&priv->lock, flags);
885
886 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500887 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500888 led &= priv->led_association_off;
889 led = ipw_register_toggle(led);
890
891 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500892 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500893
894 IPW_DEBUG_LED("Link LED Off\n");
895
896 priv->status &= ~STATUS_LED_LINK_ON;
897
898 /* If we aren't associated and the radio is on, schedule
899 * turning the LED on (blink while unassociated) */
900 if (!(priv->status & STATUS_RF_KILL_MASK) &&
901 !(priv->status & STATUS_ASSOCIATED))
902 queue_delayed_work(priv->workqueue, &priv->led_link_on,
903 LD_TIME_LINK_OFF);
904
905 }
906
907 spin_unlock_irqrestore(&priv->lock, flags);
908}
909
David Howellsc4028952006-11-22 14:57:56 +0000910static void ipw_bg_led_link_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500911{
David Howellsc4028952006-11-22 14:57:56 +0000912 struct ipw_priv *priv =
913 container_of(work, struct ipw_priv, led_link_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800914 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000915 ipw_led_link_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800916 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500917}
918
Arjan van de Ven858119e2006-01-14 13:20:43 -0800919static void __ipw_led_activity_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500920{
James Ketrenosa613bff2005-08-24 21:43:11 -0500921 u32 led;
922
923 if (priv->config & CFG_NO_LED)
924 return;
925
James Ketrenosb095c382005-08-24 22:04:42 -0500926 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -0500927 return;
James Ketrenosa613bff2005-08-24 21:43:11 -0500928
929 if (!(priv->status & STATUS_LED_ACT_ON)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500930 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500931 led |= priv->led_activity_on;
932
933 led = ipw_register_toggle(led);
934
935 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500936 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500937
938 IPW_DEBUG_LED("Activity LED On\n");
939
940 priv->status |= STATUS_LED_ACT_ON;
941
James Ketrenosc848d0a2005-08-24 21:56:24 -0500942 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -0500943 queue_delayed_work(priv->workqueue, &priv->led_act_off,
944 LD_TIME_ACT_ON);
945 } else {
946 /* Reschedule LED off for full time period */
947 cancel_delayed_work(&priv->led_act_off);
948 queue_delayed_work(priv->workqueue, &priv->led_act_off,
949 LD_TIME_ACT_ON);
950 }
James Ketrenosb095c382005-08-24 22:04:42 -0500951}
James Ketrenosa613bff2005-08-24 21:43:11 -0500952
Adrian Bunka73e22b2006-01-21 01:39:42 +0100953#if 0
James Ketrenosb095c382005-08-24 22:04:42 -0500954void ipw_led_activity_on(struct ipw_priv *priv)
955{
956 unsigned long flags;
957 spin_lock_irqsave(&priv->lock, flags);
958 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -0500959 spin_unlock_irqrestore(&priv->lock, flags);
960}
Adrian Bunka73e22b2006-01-21 01:39:42 +0100961#endif /* 0 */
James Ketrenosa613bff2005-08-24 21:43:11 -0500962
Adrian Bunka73e22b2006-01-21 01:39:42 +0100963static void ipw_led_activity_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500964{
965 unsigned long flags;
966 u32 led;
967
968 if (priv->config & CFG_NO_LED)
969 return;
970
971 spin_lock_irqsave(&priv->lock, flags);
972
973 if (priv->status & STATUS_LED_ACT_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500974 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500975 led &= priv->led_activity_off;
976
977 led = ipw_register_toggle(led);
978
979 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500980 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500981
982 IPW_DEBUG_LED("Activity LED Off\n");
983
984 priv->status &= ~STATUS_LED_ACT_ON;
985 }
986
987 spin_unlock_irqrestore(&priv->lock, flags);
988}
989
David Howellsc4028952006-11-22 14:57:56 +0000990static void ipw_bg_led_activity_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500991{
David Howellsc4028952006-11-22 14:57:56 +0000992 struct ipw_priv *priv =
993 container_of(work, struct ipw_priv, led_act_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800994 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000995 ipw_led_activity_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800996 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500997}
998
Adrian Bunka73e22b2006-01-21 01:39:42 +0100999static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001000{
1001 unsigned long flags;
1002 u32 led;
1003
1004 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001005 if (priv->config & CFG_NO_LED ||
1006 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001007 return;
1008
1009 spin_lock_irqsave(&priv->lock, flags);
1010
James Ketrenosb095c382005-08-24 22:04:42 -05001011 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001012 if (priv->assoc_network->mode == IEEE_A) {
1013 led |= priv->led_ofdm_on;
1014 led &= priv->led_association_off;
1015 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1016 } else if (priv->assoc_network->mode == IEEE_G) {
1017 led |= priv->led_ofdm_on;
1018 led |= priv->led_association_on;
1019 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1020 } else {
1021 led &= priv->led_ofdm_off;
1022 led |= priv->led_association_on;
1023 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1024 }
1025
1026 led = ipw_register_toggle(led);
1027
1028 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001029 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001030
1031 spin_unlock_irqrestore(&priv->lock, flags);
1032}
1033
Adrian Bunka73e22b2006-01-21 01:39:42 +01001034static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001035{
1036 unsigned long flags;
1037 u32 led;
1038
1039 /* Only nic type 1 supports mode LEDs */
1040 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1041 return;
1042
1043 spin_lock_irqsave(&priv->lock, flags);
1044
James Ketrenosb095c382005-08-24 22:04:42 -05001045 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001046 led &= priv->led_ofdm_off;
1047 led &= priv->led_association_off;
1048
1049 led = ipw_register_toggle(led);
1050
1051 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001052 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001053
1054 spin_unlock_irqrestore(&priv->lock, flags);
1055}
1056
Adrian Bunka73e22b2006-01-21 01:39:42 +01001057static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001058{
1059 ipw_led_link_on(priv);
1060}
1061
Adrian Bunka73e22b2006-01-21 01:39:42 +01001062static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001063{
1064 ipw_led_activity_off(priv);
1065 ipw_led_link_off(priv);
1066}
1067
Adrian Bunka73e22b2006-01-21 01:39:42 +01001068static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001069{
1070 /* Set the Link Led on for all nic types */
1071 ipw_led_link_on(priv);
1072}
1073
Adrian Bunka73e22b2006-01-21 01:39:42 +01001074static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001075{
1076 ipw_led_activity_off(priv);
1077 ipw_led_link_off(priv);
1078
1079 if (priv->status & STATUS_RF_KILL_MASK)
1080 ipw_led_radio_off(priv);
1081}
1082
Adrian Bunka73e22b2006-01-21 01:39:42 +01001083static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001084{
1085 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1086
1087 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001088 priv->led_activity_on = IPW_ACTIVITY_LED;
1089 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001090
James Ketrenosb095c382005-08-24 22:04:42 -05001091 priv->led_association_on = IPW_ASSOCIATED_LED;
1092 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001093
1094 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001095 priv->led_ofdm_on = IPW_OFDM_LED;
1096 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001097
1098 switch (priv->nic_type) {
1099 case EEPROM_NIC_TYPE_1:
1100 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001101 priv->led_activity_on = IPW_ASSOCIATED_LED;
1102 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1103 priv->led_association_on = IPW_ACTIVITY_LED;
1104 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001105
1106 if (!(priv->config & CFG_NO_LED))
1107 ipw_led_band_on(priv);
1108
1109 /* And we don't blink link LEDs for this nic, so
1110 * just return here */
1111 return;
1112
1113 case EEPROM_NIC_TYPE_3:
1114 case EEPROM_NIC_TYPE_2:
1115 case EEPROM_NIC_TYPE_4:
1116 case EEPROM_NIC_TYPE_0:
1117 break;
1118
1119 default:
1120 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1121 priv->nic_type);
1122 priv->nic_type = EEPROM_NIC_TYPE_0;
1123 break;
1124 }
1125
1126 if (!(priv->config & CFG_NO_LED)) {
1127 if (priv->status & STATUS_ASSOCIATED)
1128 ipw_led_link_on(priv);
1129 else
1130 ipw_led_link_off(priv);
1131 }
1132}
1133
Adrian Bunka73e22b2006-01-21 01:39:42 +01001134static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001135{
James Ketrenosa613bff2005-08-24 21:43:11 -05001136 ipw_led_activity_off(priv);
1137 ipw_led_link_off(priv);
1138 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001139 cancel_delayed_work(&priv->led_link_on);
1140 cancel_delayed_work(&priv->led_link_off);
1141 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001142}
1143
James Ketrenos43f66a62005-03-25 12:31:53 -06001144/*
1145 * The following adds a new attribute to the sysfs representation
1146 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1147 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001148 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001149 * See the level definitions in ipw for details.
1150 */
1151static ssize_t show_debug_level(struct device_driver *d, char *buf)
1152{
1153 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1154}
James Ketrenosa613bff2005-08-24 21:43:11 -05001155
1156static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1157 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001158{
1159 char *p = (char *)buf;
1160 u32 val;
1161
1162 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1163 p++;
1164 if (p[0] == 'x' || p[0] == 'X')
1165 p++;
1166 val = simple_strtoul(p, &p, 16);
1167 } else
1168 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001169 if (p == buf)
1170 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001171 ": %s is not in hex or decimal form.\n", buf);
1172 else
1173 ipw_debug_level = val;
1174
1175 return strnlen(buf, count);
1176}
1177
Jeff Garzikbf794512005-07-31 13:07:26 -04001178static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001179 show_debug_level, store_debug_level);
1180
James Ketrenosb39860c2005-08-12 09:36:32 -05001181static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1182{
Zhu Yic8fe6672006-01-24 16:36:36 +08001183 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001184 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1185}
1186
1187static void ipw_capture_event_log(struct ipw_priv *priv,
1188 u32 log_len, struct ipw_event *log)
1189{
1190 u32 base;
1191
1192 if (log_len) {
1193 base = ipw_read32(priv, IPW_EVENT_LOG);
1194 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1195 (u8 *) log, sizeof(*log) * log_len);
1196 }
1197}
1198
1199static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1200{
1201 struct ipw_fw_error *error;
1202 u32 log_len = ipw_get_event_log_len(priv);
1203 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1204 u32 elem_len = ipw_read_reg32(priv, base);
1205
1206 error = kmalloc(sizeof(*error) +
1207 sizeof(*error->elem) * elem_len +
1208 sizeof(*error->log) * log_len, GFP_ATOMIC);
1209 if (!error) {
1210 IPW_ERROR("Memory allocation for firmware error log "
1211 "failed.\n");
1212 return NULL;
1213 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001214 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001215 error->status = priv->status;
1216 error->config = priv->config;
1217 error->elem_len = elem_len;
1218 error->log_len = log_len;
1219 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001220 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001221
1222 ipw_capture_event_log(priv, log_len, error->log);
1223
1224 if (elem_len)
1225 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1226 sizeof(*error->elem) * elem_len);
1227
1228 return error;
1229}
1230
James Ketrenosb39860c2005-08-12 09:36:32 -05001231static ssize_t show_event_log(struct device *d,
1232 struct device_attribute *attr, char *buf)
1233{
1234 struct ipw_priv *priv = dev_get_drvdata(d);
1235 u32 log_len = ipw_get_event_log_len(priv);
1236 struct ipw_event log[log_len];
1237 u32 len = 0, i;
1238
1239 ipw_capture_event_log(priv, log_len, log);
1240
1241 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1242 for (i = 0; i < log_len; i++)
1243 len += snprintf(buf + len, PAGE_SIZE - len,
1244 "\n%08X%08X%08X",
1245 log[i].time, log[i].event, log[i].data);
1246 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1247 return len;
1248}
1249
1250static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1251
1252static ssize_t show_error(struct device *d,
1253 struct device_attribute *attr, char *buf)
1254{
1255 struct ipw_priv *priv = dev_get_drvdata(d);
1256 u32 len = 0, i;
1257 if (!priv->error)
1258 return 0;
1259 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001260 "%08lX%08X%08X%08X",
1261 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001262 priv->error->status,
1263 priv->error->config, priv->error->elem_len);
1264 for (i = 0; i < priv->error->elem_len; i++)
1265 len += snprintf(buf + len, PAGE_SIZE - len,
1266 "\n%08X%08X%08X%08X%08X%08X%08X",
1267 priv->error->elem[i].time,
1268 priv->error->elem[i].desc,
1269 priv->error->elem[i].blink1,
1270 priv->error->elem[i].blink2,
1271 priv->error->elem[i].link1,
1272 priv->error->elem[i].link2,
1273 priv->error->elem[i].data);
1274
1275 len += snprintf(buf + len, PAGE_SIZE - len,
1276 "\n%08X", priv->error->log_len);
1277 for (i = 0; i < priv->error->log_len; i++)
1278 len += snprintf(buf + len, PAGE_SIZE - len,
1279 "\n%08X%08X%08X",
1280 priv->error->log[i].time,
1281 priv->error->log[i].event,
1282 priv->error->log[i].data);
1283 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1284 return len;
1285}
1286
1287static ssize_t clear_error(struct device *d,
1288 struct device_attribute *attr,
1289 const char *buf, size_t count)
1290{
1291 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001292
1293 kfree(priv->error);
1294 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001295 return count;
1296}
1297
1298static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1299
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001300static ssize_t show_cmd_log(struct device *d,
1301 struct device_attribute *attr, char *buf)
1302{
1303 struct ipw_priv *priv = dev_get_drvdata(d);
1304 u32 len = 0, i;
1305 if (!priv->cmdlog)
1306 return 0;
1307 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1308 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1309 i = (i + 1) % priv->cmdlog_len) {
1310 len +=
1311 snprintf(buf + len, PAGE_SIZE - len,
1312 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1313 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1314 priv->cmdlog[i].cmd.len);
1315 len +=
1316 snprintk_buf(buf + len, PAGE_SIZE - len,
1317 (u8 *) priv->cmdlog[i].cmd.param,
1318 priv->cmdlog[i].cmd.len);
1319 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1320 }
1321 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1322 return len;
1323}
1324
1325static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1326
Zhu Yid685b8c2006-04-13 17:20:27 +08001327#ifdef CONFIG_IPW2200_PROMISCUOUS
1328static void ipw_prom_free(struct ipw_priv *priv);
1329static int ipw_prom_alloc(struct ipw_priv *priv);
1330static ssize_t store_rtap_iface(struct device *d,
1331 struct device_attribute *attr,
1332 const char *buf, size_t count)
1333{
1334 struct ipw_priv *priv = dev_get_drvdata(d);
1335 int rc = 0;
1336
1337 if (count < 1)
1338 return -EINVAL;
1339
1340 switch (buf[0]) {
1341 case '0':
1342 if (!rtap_iface)
1343 return count;
1344
1345 if (netif_running(priv->prom_net_dev)) {
1346 IPW_WARNING("Interface is up. Cannot unregister.\n");
1347 return count;
1348 }
1349
1350 ipw_prom_free(priv);
1351 rtap_iface = 0;
1352 break;
1353
1354 case '1':
1355 if (rtap_iface)
1356 return count;
1357
1358 rc = ipw_prom_alloc(priv);
1359 if (!rc)
1360 rtap_iface = 1;
1361 break;
1362
1363 default:
1364 return -EINVAL;
1365 }
1366
1367 if (rc) {
1368 IPW_ERROR("Failed to register promiscuous network "
1369 "device (error %d).\n", rc);
1370 }
1371
1372 return count;
1373}
1374
1375static ssize_t show_rtap_iface(struct device *d,
1376 struct device_attribute *attr,
1377 char *buf)
1378{
1379 struct ipw_priv *priv = dev_get_drvdata(d);
1380 if (rtap_iface)
1381 return sprintf(buf, "%s", priv->prom_net_dev->name);
1382 else {
1383 buf[0] = '-';
1384 buf[1] = '1';
1385 buf[2] = '\0';
1386 return 3;
1387 }
1388}
1389
1390static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1391 store_rtap_iface);
1392
1393static ssize_t store_rtap_filter(struct device *d,
1394 struct device_attribute *attr,
1395 const char *buf, size_t count)
1396{
1397 struct ipw_priv *priv = dev_get_drvdata(d);
1398
1399 if (!priv->prom_priv) {
1400 IPW_ERROR("Attempting to set filter without "
1401 "rtap_iface enabled.\n");
1402 return -EPERM;
1403 }
1404
1405 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1406
1407 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1408 BIT_ARG16(priv->prom_priv->filter));
1409
1410 return count;
1411}
1412
1413static ssize_t show_rtap_filter(struct device *d,
1414 struct device_attribute *attr,
1415 char *buf)
1416{
1417 struct ipw_priv *priv = dev_get_drvdata(d);
1418 return sprintf(buf, "0x%04X",
1419 priv->prom_priv ? priv->prom_priv->filter : 0);
1420}
1421
1422static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1423 store_rtap_filter);
1424#endif
1425
James Ketrenosa613bff2005-08-24 21:43:11 -05001426static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1427 char *buf)
1428{
1429 struct ipw_priv *priv = dev_get_drvdata(d);
1430 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1431}
1432
1433static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1434 const char *buf, size_t count)
1435{
1436 struct ipw_priv *priv = dev_get_drvdata(d);
1437 struct net_device *dev = priv->net_dev;
1438 char buffer[] = "00000000";
1439 unsigned long len =
1440 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1441 unsigned long val;
1442 char *p = buffer;
1443
1444 IPW_DEBUG_INFO("enter\n");
1445
1446 strncpy(buffer, buf, len);
1447 buffer[len] = 0;
1448
1449 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1450 p++;
1451 if (p[0] == 'x' || p[0] == 'X')
1452 p++;
1453 val = simple_strtoul(p, &p, 16);
1454 } else
1455 val = simple_strtoul(p, &p, 10);
1456 if (p == buffer) {
1457 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1458 } else {
1459 priv->ieee->scan_age = val;
1460 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1461 }
1462
1463 IPW_DEBUG_INFO("exit\n");
1464 return len;
1465}
1466
1467static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1468
1469static ssize_t show_led(struct device *d, struct device_attribute *attr,
1470 char *buf)
1471{
1472 struct ipw_priv *priv = dev_get_drvdata(d);
1473 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1474}
1475
1476static ssize_t store_led(struct device *d, struct device_attribute *attr,
1477 const char *buf, size_t count)
1478{
1479 struct ipw_priv *priv = dev_get_drvdata(d);
1480
1481 IPW_DEBUG_INFO("enter\n");
1482
1483 if (count == 0)
1484 return 0;
1485
1486 if (*buf == 0) {
1487 IPW_DEBUG_LED("Disabling LED control.\n");
1488 priv->config |= CFG_NO_LED;
1489 ipw_led_shutdown(priv);
1490 } else {
1491 IPW_DEBUG_LED("Enabling LED control.\n");
1492 priv->config &= ~CFG_NO_LED;
1493 ipw_led_init(priv);
1494 }
1495
1496 IPW_DEBUG_INFO("exit\n");
1497 return count;
1498}
1499
1500static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1501
Andrew Mortonad3fee52005-06-20 14:30:36 -07001502static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001503 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001504{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001505 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001506 return sprintf(buf, "0x%08x\n", (int)p->status);
1507}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001508
James Ketrenos43f66a62005-03-25 12:31:53 -06001509static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1510
Andrew Mortonad3fee52005-06-20 14:30:36 -07001511static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1512 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001513{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001514 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001515 return sprintf(buf, "0x%08x\n", (int)p->config);
1516}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001517
James Ketrenos43f66a62005-03-25 12:31:53 -06001518static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1519
Andrew Mortonad3fee52005-06-20 14:30:36 -07001520static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001521 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001522{
James Ketrenosa613bff2005-08-24 21:43:11 -05001523 struct ipw_priv *priv = d->driver_data;
1524 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001525}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001526
James Ketrenos43f66a62005-03-25 12:31:53 -06001527static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1528
Andrew Mortonad3fee52005-06-20 14:30:36 -07001529static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001530 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001531{
1532 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001533 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001534
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001535 if (ipw_get_ordinal(p, IPW_ORD_STAT_UCODE_VERSION, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001536 return 0;
1537
1538 return sprintf(buf, "0x%08x\n", tmp);
1539}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001540
1541static DEVICE_ATTR(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001542
Andrew Mortonad3fee52005-06-20 14:30:36 -07001543static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1544 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001545{
1546 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001547 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001548
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001549 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001550 return 0;
1551
1552 return sprintf(buf, "0x%08x\n", tmp);
1553}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001554
1555static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001556
1557/*
1558 * Add a device attribute to view/control the delay between eeprom
1559 * operations.
1560 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001561static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001562 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001563{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001564 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001565 return sprintf(buf, "%i\n", n);
1566}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001567static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001568 struct device_attribute *attr,
1569 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001570{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001571 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001572 sscanf(buf, "%i", &p->eeprom_delay);
1573 return strnlen(buf, count);
1574}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001575
1576static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1577 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001578
Andrew Mortonad3fee52005-06-20 14:30:36 -07001579static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001580 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001581{
1582 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001583 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001584
James Ketrenosb095c382005-08-24 22:04:42 -05001585 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001586 return sprintf(buf, "0x%08x\n", reg);
1587}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001588static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001589 struct device_attribute *attr,
1590 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001591{
1592 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001593 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001594
1595 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001596 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001597 return strnlen(buf, count);
1598}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001599
1600static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1601 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001602
Andrew Mortonad3fee52005-06-20 14:30:36 -07001603static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001604 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001605{
1606 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001607 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001608
1609 reg = ipw_read_reg32(p, 0x301100);
1610 return sprintf(buf, "0x%08x\n", reg);
1611}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001612static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001613 struct device_attribute *attr,
1614 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001615{
1616 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001617 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001618
1619 sscanf(buf, "%x", &reg);
1620 ipw_write_reg32(p, 0x301100, reg);
1621 return strnlen(buf, count);
1622}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001623
1624static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1625 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001626
Andrew Mortonad3fee52005-06-20 14:30:36 -07001627static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001628 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001629{
1630 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001631 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001632
Jeff Garzikbf794512005-07-31 13:07:26 -04001633 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001634 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001635 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001636 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001637
James Ketrenos43f66a62005-03-25 12:31:53 -06001638 return sprintf(buf, "0x%08x\n", reg);
1639}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001640static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001641 struct device_attribute *attr,
1642 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001643{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001644 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001645
1646 sscanf(buf, "%x", &priv->indirect_dword);
1647 priv->status |= STATUS_INDIRECT_DWORD;
1648 return strnlen(buf, count);
1649}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001650
1651static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1652 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001653
Andrew Mortonad3fee52005-06-20 14:30:36 -07001654static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001655 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001656{
1657 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001658 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001659
Jeff Garzikbf794512005-07-31 13:07:26 -04001660 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001661 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001662 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001663 reg = 0;
1664
1665 return sprintf(buf, "0x%02x\n", reg);
1666}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001667static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001668 struct device_attribute *attr,
1669 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001670{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001671 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001672
1673 sscanf(buf, "%x", &priv->indirect_byte);
1674 priv->status |= STATUS_INDIRECT_BYTE;
1675 return strnlen(buf, count);
1676}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001677
1678static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001679 show_indirect_byte, store_indirect_byte);
1680
Andrew Mortonad3fee52005-06-20 14:30:36 -07001681static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001682 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001683{
1684 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001685 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001686
Jeff Garzikbf794512005-07-31 13:07:26 -04001687 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001688 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001689 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001690 reg = 0;
1691
1692 return sprintf(buf, "0x%08x\n", reg);
1693}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001694static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001695 struct device_attribute *attr,
1696 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001697{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001698 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001699
1700 sscanf(buf, "%x", &priv->direct_dword);
1701 priv->status |= STATUS_DIRECT_DWORD;
1702 return strnlen(buf, count);
1703}
James Ketrenos43f66a62005-03-25 12:31:53 -06001704
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001705static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1706 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001707
Arjan van de Ven858119e2006-01-14 13:20:43 -08001708static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001709{
1710 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1711 priv->status |= STATUS_RF_KILL_HW;
1712 else
1713 priv->status &= ~STATUS_RF_KILL_HW;
1714
1715 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1716}
1717
Andrew Mortonad3fee52005-06-20 14:30:36 -07001718static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001719 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001720{
1721 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001722 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001723 2 - HW based RF kill active
1724 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001725 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001726 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001727 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001728 return sprintf(buf, "%i\n", val);
1729}
1730
1731static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1732{
Jeff Garzikbf794512005-07-31 13:07:26 -04001733 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001734 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001735 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001736
1737 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1738 disable_radio ? "OFF" : "ON");
1739
1740 if (disable_radio) {
1741 priv->status |= STATUS_RF_KILL_SW;
1742
James Ketrenosa613bff2005-08-24 21:43:11 -05001743 if (priv->workqueue)
James Ketrenos43f66a62005-03-25 12:31:53 -06001744 cancel_delayed_work(&priv->request_scan);
James Ketrenos43f66a62005-03-25 12:31:53 -06001745 queue_work(priv->workqueue, &priv->down);
1746 } else {
1747 priv->status &= ~STATUS_RF_KILL_SW;
1748 if (rf_kill_active(priv)) {
1749 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1750 "disabled by HW switch\n");
1751 /* Make sure the RF_KILL check timer is running */
1752 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001753 queue_delayed_work(priv->workqueue, &priv->rf_kill,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07001754 round_jiffies(2 * HZ));
Jeff Garzikbf794512005-07-31 13:07:26 -04001755 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001756 queue_work(priv->workqueue, &priv->up);
1757 }
1758
1759 return 1;
1760}
1761
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001762static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1763 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001764{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001765 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001766
James Ketrenos43f66a62005-03-25 12:31:53 -06001767 ipw_radio_kill_sw(priv, buf[0] == '1');
1768
1769 return count;
1770}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001771
1772static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001773
James Ketrenosb095c382005-08-24 22:04:42 -05001774static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1775 char *buf)
1776{
1777 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1778 int pos = 0, len = 0;
1779 if (priv->config & CFG_SPEED_SCAN) {
1780 while (priv->speed_scan[pos] != 0)
1781 len += sprintf(&buf[len], "%d ",
1782 priv->speed_scan[pos++]);
1783 return len + sprintf(&buf[len], "\n");
1784 }
1785
1786 return sprintf(buf, "0\n");
1787}
1788
1789static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1790 const char *buf, size_t count)
1791{
1792 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1793 int channel, pos = 0;
1794 const char *p = buf;
1795
1796 /* list of space separated channels to scan, optionally ending with 0 */
1797 while ((channel = simple_strtol(p, NULL, 0))) {
1798 if (pos == MAX_SPEED_SCAN - 1) {
1799 priv->speed_scan[pos] = 0;
1800 break;
1801 }
1802
Larry Finger1867b112006-02-28 09:48:28 -06001803 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001804 priv->speed_scan[pos++] = channel;
1805 else
1806 IPW_WARNING("Skipping invalid channel request: %d\n",
1807 channel);
1808 p = strchr(p, ' ');
1809 if (!p)
1810 break;
1811 while (*p == ' ' || *p == '\t')
1812 p++;
1813 }
1814
1815 if (pos == 0)
1816 priv->config &= ~CFG_SPEED_SCAN;
1817 else {
1818 priv->speed_scan_pos = 0;
1819 priv->config |= CFG_SPEED_SCAN;
1820 }
1821
1822 return count;
1823}
1824
1825static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1826 store_speed_scan);
1827
1828static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1829 char *buf)
1830{
1831 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1832 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1833}
1834
1835static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1836 const char *buf, size_t count)
1837{
1838 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1839 if (buf[0] == '1')
1840 priv->config |= CFG_NET_STATS;
1841 else
1842 priv->config &= ~CFG_NET_STATS;
1843
1844 return count;
1845}
1846
James Ketrenosafbf30a2005-08-25 00:05:33 -05001847static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1848 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001849
Zhu Yi375dd242007-02-14 16:04:24 +08001850static ssize_t show_channels(struct device *d,
1851 struct device_attribute *attr,
1852 char *buf)
1853{
1854 struct ipw_priv *priv = dev_get_drvdata(d);
Andrew Morton742e9912007-03-01 08:19:29 -05001855 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi375dd242007-02-14 16:04:24 +08001856 int len = 0, i;
1857
1858 len = sprintf(&buf[len],
1859 "Displaying %d channels in 2.4Ghz band "
1860 "(802.11bg):\n", geo->bg_channels);
1861
1862 for (i = 0; i < geo->bg_channels; i++) {
1863 len += sprintf(&buf[len], "%d: BSS%s%s, %s, Band %s.\n",
1864 geo->bg[i].channel,
1865 geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT ?
1866 " (radar spectrum)" : "",
1867 ((geo->bg[i].flags & IEEE80211_CH_NO_IBSS) ||
1868 (geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT))
1869 ? "" : ", IBSS",
1870 geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1871 "passive only" : "active/passive",
1872 geo->bg[i].flags & IEEE80211_CH_B_ONLY ?
1873 "B" : "B/G");
1874 }
1875
1876 len += sprintf(&buf[len],
1877 "Displaying %d channels in 5.2Ghz band "
1878 "(802.11a):\n", geo->a_channels);
1879 for (i = 0; i < geo->a_channels; i++) {
1880 len += sprintf(&buf[len], "%d: BSS%s%s, %s.\n",
1881 geo->a[i].channel,
1882 geo->a[i].flags & IEEE80211_CH_RADAR_DETECT ?
1883 " (radar spectrum)" : "",
1884 ((geo->a[i].flags & IEEE80211_CH_NO_IBSS) ||
1885 (geo->a[i].flags & IEEE80211_CH_RADAR_DETECT))
1886 ? "" : ", IBSS",
1887 geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1888 "passive only" : "active/passive");
1889 }
1890
1891 return len;
1892}
1893
1894static DEVICE_ATTR(channels, S_IRUSR, show_channels, NULL);
1895
James Ketrenosea2b26e2005-08-24 21:25:16 -05001896static void notify_wx_assoc_event(struct ipw_priv *priv)
1897{
1898 union iwreq_data wrqu;
1899 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1900 if (priv->status & STATUS_ASSOCIATED)
1901 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1902 else
1903 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1904 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1905}
1906
James Ketrenos43f66a62005-03-25 12:31:53 -06001907static void ipw_irq_tasklet(struct ipw_priv *priv)
1908{
1909 u32 inta, inta_mask, handled = 0;
1910 unsigned long flags;
1911 int rc = 0;
1912
Zhu Yi89c318e2006-06-08 22:19:49 -07001913 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001914
James Ketrenosb095c382005-08-24 22:04:42 -05001915 inta = ipw_read32(priv, IPW_INTA_RW);
1916 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1917 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001918
1919 /* Add any cached INTA values that need to be handled */
1920 inta |= priv->isr_inta;
1921
Zhu Yi89c318e2006-06-08 22:19:49 -07001922 spin_unlock_irqrestore(&priv->irq_lock, flags);
1923
1924 spin_lock_irqsave(&priv->lock, flags);
1925
James Ketrenos43f66a62005-03-25 12:31:53 -06001926 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001927 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001928 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001929 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001930 }
1931
James Ketrenosb095c382005-08-24 22:04:42 -05001932 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001933 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001934 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001935 priv->status &= ~STATUS_HCMD_ACTIVE;
1936 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001937 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001938 }
1939
James Ketrenosb095c382005-08-24 22:04:42 -05001940 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001941 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001942 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001943 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001944 }
1945
James Ketrenosb095c382005-08-24 22:04:42 -05001946 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001947 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001948 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001949 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001950 }
1951
James Ketrenosb095c382005-08-24 22:04:42 -05001952 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001953 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001954 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001955 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001956 }
1957
James Ketrenosb095c382005-08-24 22:04:42 -05001958 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001959 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001960 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001961 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001962 }
1963
James Ketrenosb095c382005-08-24 22:04:42 -05001964 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001965 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001966 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001967 }
1968
James Ketrenosb095c382005-08-24 22:04:42 -05001969 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001970 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001971 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06001972 }
1973
James Ketrenosb095c382005-08-24 22:04:42 -05001974 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001975 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001976 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001977 }
1978
James Ketrenosb095c382005-08-24 22:04:42 -05001979 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001980 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001981 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001982 }
1983
James Ketrenosb095c382005-08-24 22:04:42 -05001984 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001985 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001986 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001987 }
1988
James Ketrenosb095c382005-08-24 22:04:42 -05001989 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001990 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
1991 priv->status |= STATUS_RF_KILL_HW;
1992 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05001993 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06001994 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05001995 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06001996 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05001997 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001998 }
Jeff Garzikbf794512005-07-31 13:07:26 -04001999
James Ketrenosb095c382005-08-24 22:04:42 -05002000 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002001 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002002 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002003 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002004 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
2005 struct ipw_fw_error *error =
2006 ipw_alloc_error_log(priv);
2007 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07002008 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002009 }
James Ketrenosb39860c2005-08-12 09:36:32 -05002010 } else {
2011 priv->error = ipw_alloc_error_log(priv);
2012 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002013 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002014 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002015 IPW_DEBUG_FW("Error allocating sysfs 'error' "
2016 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002017 if (ipw_debug_level & IPW_DL_FW_ERRORS)
2018 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002019 }
2020
James Ketrenosb095c382005-08-24 22:04:42 -05002021 /* XXX: If hardware encryption is for WPA/WPA2,
2022 * we have to notify the supplicant. */
2023 if (priv->ieee->sec.encrypt) {
2024 priv->status &= ~STATUS_ASSOCIATED;
2025 notify_wx_assoc_event(priv);
2026 }
2027
2028 /* Keep the restart process from trying to send host
2029 * commands by clearing the INIT status bit */
2030 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05002031
2032 /* Cancel currently queued command. */
2033 priv->status &= ~STATUS_HCMD_ACTIVE;
2034 wake_up_interruptible(&priv->wait_command_queue);
2035
James Ketrenos43f66a62005-03-25 12:31:53 -06002036 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05002037 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002038 }
2039
James Ketrenosb095c382005-08-24 22:04:42 -05002040 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002041 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002042 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002043 }
2044
2045 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002046 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002047 }
2048
Zhu Yi89c318e2006-06-08 22:19:49 -07002049 spin_unlock_irqrestore(&priv->lock, flags);
2050
James Ketrenos43f66a62005-03-25 12:31:53 -06002051 /* enable all interrupts */
2052 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002053}
Jeff Garzikbf794512005-07-31 13:07:26 -04002054
James Ketrenos43f66a62005-03-25 12:31:53 -06002055#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2056static char *get_cmd_string(u8 cmd)
2057{
2058 switch (cmd) {
2059 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002060 IPW_CMD(POWER_DOWN);
2061 IPW_CMD(SYSTEM_CONFIG);
2062 IPW_CMD(MULTICAST_ADDRESS);
2063 IPW_CMD(SSID);
2064 IPW_CMD(ADAPTER_ADDRESS);
2065 IPW_CMD(PORT_TYPE);
2066 IPW_CMD(RTS_THRESHOLD);
2067 IPW_CMD(FRAG_THRESHOLD);
2068 IPW_CMD(POWER_MODE);
2069 IPW_CMD(WEP_KEY);
2070 IPW_CMD(TGI_TX_KEY);
2071 IPW_CMD(SCAN_REQUEST);
2072 IPW_CMD(SCAN_REQUEST_EXT);
2073 IPW_CMD(ASSOCIATE);
2074 IPW_CMD(SUPPORTED_RATES);
2075 IPW_CMD(SCAN_ABORT);
2076 IPW_CMD(TX_FLUSH);
2077 IPW_CMD(QOS_PARAMETERS);
2078 IPW_CMD(DINO_CONFIG);
2079 IPW_CMD(RSN_CAPABILITIES);
2080 IPW_CMD(RX_KEY);
2081 IPW_CMD(CARD_DISABLE);
2082 IPW_CMD(SEED_NUMBER);
2083 IPW_CMD(TX_POWER);
2084 IPW_CMD(COUNTRY_INFO);
2085 IPW_CMD(AIRONET_INFO);
2086 IPW_CMD(AP_TX_POWER);
2087 IPW_CMD(CCKM_INFO);
2088 IPW_CMD(CCX_VER_INFO);
2089 IPW_CMD(SET_CALIBRATION);
2090 IPW_CMD(SENSITIVITY_CALIB);
2091 IPW_CMD(RETRY_LIMIT);
2092 IPW_CMD(IPW_PRE_POWER_DOWN);
2093 IPW_CMD(VAP_BEACON_TEMPLATE);
2094 IPW_CMD(VAP_DTIM_PERIOD);
2095 IPW_CMD(EXT_SUPPORTED_RATES);
2096 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2097 IPW_CMD(VAP_QUIET_INTERVALS);
2098 IPW_CMD(VAP_CHANNEL_SWITCH);
2099 IPW_CMD(VAP_MANDATORY_CHANNELS);
2100 IPW_CMD(VAP_CELL_PWR_LIMIT);
2101 IPW_CMD(VAP_CF_PARAM_SET);
2102 IPW_CMD(VAP_SET_BEACONING_STATE);
2103 IPW_CMD(MEASUREMENT);
2104 IPW_CMD(POWER_CAPABILITY);
2105 IPW_CMD(SUPPORTED_CHANNELS);
2106 IPW_CMD(TPC_REPORT);
2107 IPW_CMD(WME_INFO);
2108 IPW_CMD(PRODUCTION_COMMAND);
2109 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002110 return "UNKNOWN";
2111 }
2112}
James Ketrenos43f66a62005-03-25 12:31:53 -06002113
2114#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002115
2116static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002117{
2118 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002119 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002120
James Ketrenosa613bff2005-08-24 21:43:11 -05002121 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002122 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002123 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2124 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002125 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002126 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002127 }
2128
2129 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002130
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002131 if (priv->cmdlog) {
2132 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2133 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2134 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2135 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2136 cmd->len);
2137 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2138 }
2139
James Ketrenosb095c382005-08-24 22:04:42 -05002140 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2141 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2142 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002143
2144#ifndef DEBUG_CMD_WEP_KEY
2145 if (cmd->cmd == IPW_CMD_WEP_KEY)
2146 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2147 else
2148#endif
2149 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2150
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002151 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002152 if (rc) {
2153 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002154 IPW_ERROR("Failed to send %s: Reason %d\n",
2155 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002156 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002157 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002158 }
2159 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002160
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002161 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2162 !(priv->
2163 status & STATUS_HCMD_ACTIVE),
2164 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002165 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002166 spin_lock_irqsave(&priv->lock, flags);
2167 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002168 IPW_ERROR("Failed to send %s: Command timed out.\n",
2169 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002170 priv->status &= ~STATUS_HCMD_ACTIVE;
2171 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002172 rc = -EIO;
2173 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002174 }
2175 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002176 } else
2177 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002178
James Ketrenosb095c382005-08-24 22:04:42 -05002179 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002180 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2181 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002182 rc = -EIO;
2183 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002184 }
2185
Zhu Yi2638bc32006-01-24 16:37:52 +08002186 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002187 if (priv->cmdlog) {
2188 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2189 priv->cmdlog_pos %= priv->cmdlog_len;
2190 }
2191 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002192}
2193
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002194static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002195{
2196 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002197 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002198 };
2199
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002200 return __ipw_send_cmd(priv, &cmd);
2201}
2202
2203static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2204 void *data)
2205{
2206 struct host_cmd cmd = {
2207 .cmd = command,
2208 .len = len,
2209 .param = data,
2210 };
2211
2212 return __ipw_send_cmd(priv, &cmd);
2213}
2214
2215static int ipw_send_host_complete(struct ipw_priv *priv)
2216{
James Ketrenos43f66a62005-03-25 12:31:53 -06002217 if (!priv) {
2218 IPW_ERROR("Invalid args\n");
2219 return -1;
2220 }
2221
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002222 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002223}
2224
Zhu Yid685b8c2006-04-13 17:20:27 +08002225static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002226{
Zhu Yid685b8c2006-04-13 17:20:27 +08002227 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2228 sizeof(priv->sys_config),
2229 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002230}
2231
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002232static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002233{
James Ketrenos43f66a62005-03-25 12:31:53 -06002234 if (!priv || !ssid) {
2235 IPW_ERROR("Invalid args\n");
2236 return -1;
2237 }
2238
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002239 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002240 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002241}
2242
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002243static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002244{
James Ketrenos43f66a62005-03-25 12:31:53 -06002245 if (!priv || !mac) {
2246 IPW_ERROR("Invalid args\n");
2247 return -1;
2248 }
2249
2250 IPW_DEBUG_INFO("%s: Setting MAC to " MAC_FMT "\n",
2251 priv->net_dev->name, MAC_ARG(mac));
2252
Zhu Yi2638bc32006-01-24 16:37:52 +08002253 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002254}
2255
James Ketrenosa613bff2005-08-24 21:43:11 -05002256/*
2257 * NOTE: This must be executed from our workqueue as it results in udelay
2258 * being called which may corrupt the keyboard if executed on default
2259 * workqueue
2260 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002261static void ipw_adapter_restart(void *adapter)
2262{
2263 struct ipw_priv *priv = adapter;
2264
2265 if (priv->status & STATUS_RF_KILL_MASK)
2266 return;
2267
2268 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002269
2270 if (priv->assoc_network &&
2271 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2272 ipw_remove_current_network(priv);
2273
James Ketrenos43f66a62005-03-25 12:31:53 -06002274 if (ipw_up(priv)) {
2275 IPW_ERROR("Failed to up device\n");
2276 return;
2277 }
2278}
2279
David Howellsc4028952006-11-22 14:57:56 +00002280static void ipw_bg_adapter_restart(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002281{
David Howellsc4028952006-11-22 14:57:56 +00002282 struct ipw_priv *priv =
2283 container_of(work, struct ipw_priv, adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08002284 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002285 ipw_adapter_restart(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002286 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002287}
2288
James Ketrenos43f66a62005-03-25 12:31:53 -06002289#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2290
2291static void ipw_scan_check(void *data)
2292{
2293 struct ipw_priv *priv = data;
2294 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2295 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002296 "adapter after (%dms).\n",
2297 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002298 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002299 }
2300}
2301
David Howellsc4028952006-11-22 14:57:56 +00002302static void ipw_bg_scan_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002303{
David Howellsc4028952006-11-22 14:57:56 +00002304 struct ipw_priv *priv =
2305 container_of(work, struct ipw_priv, scan_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08002306 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002307 ipw_scan_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002308 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002309}
2310
James Ketrenos43f66a62005-03-25 12:31:53 -06002311static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2312 struct ipw_scan_request_ext *request)
2313{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002314 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002315 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002316}
2317
2318static int ipw_send_scan_abort(struct ipw_priv *priv)
2319{
James Ketrenos43f66a62005-03-25 12:31:53 -06002320 if (!priv) {
2321 IPW_ERROR("Invalid args\n");
2322 return -1;
2323 }
2324
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002325 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002326}
2327
2328static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2329{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002330 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002331 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002332 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002333
2334 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002335 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002336}
2337
2338static int ipw_send_associate(struct ipw_priv *priv,
2339 struct ipw_associate *associate)
2340{
James Ketrenosa613bff2005-08-24 21:43:11 -05002341 struct ipw_associate tmp_associate;
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002342
2343 if (!priv || !associate) {
2344 IPW_ERROR("Invalid args\n");
2345 return -1;
2346 }
2347
James Ketrenosa613bff2005-08-24 21:43:11 -05002348 memcpy(&tmp_associate, associate, sizeof(*associate));
2349 tmp_associate.policy_support =
2350 cpu_to_le16(tmp_associate.policy_support);
2351 tmp_associate.assoc_tsf_msw = cpu_to_le32(tmp_associate.assoc_tsf_msw);
2352 tmp_associate.assoc_tsf_lsw = cpu_to_le32(tmp_associate.assoc_tsf_lsw);
2353 tmp_associate.capability = cpu_to_le16(tmp_associate.capability);
2354 tmp_associate.listen_interval =
2355 cpu_to_le16(tmp_associate.listen_interval);
2356 tmp_associate.beacon_interval =
2357 cpu_to_le16(tmp_associate.beacon_interval);
2358 tmp_associate.atim_window = cpu_to_le16(tmp_associate.atim_window);
2359
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002360 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(tmp_associate),
Zhu Yi2638bc32006-01-24 16:37:52 +08002361 &tmp_associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002362}
2363
2364static int ipw_send_supported_rates(struct ipw_priv *priv,
2365 struct ipw_supported_rates *rates)
2366{
James Ketrenos43f66a62005-03-25 12:31:53 -06002367 if (!priv || !rates) {
2368 IPW_ERROR("Invalid args\n");
2369 return -1;
2370 }
2371
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002372 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002373 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002374}
2375
2376static int ipw_set_random_seed(struct ipw_priv *priv)
2377{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002378 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002379
2380 if (!priv) {
2381 IPW_ERROR("Invalid args\n");
2382 return -1;
2383 }
2384
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002385 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002386
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002387 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002388}
2389
James Ketrenos43f66a62005-03-25 12:31:53 -06002390static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2391{
James Ketrenos43f66a62005-03-25 12:31:53 -06002392 if (!priv) {
2393 IPW_ERROR("Invalid args\n");
2394 return -1;
2395 }
2396
Zhu Yi851ca262006-08-21 11:37:58 +08002397 phy_off = cpu_to_le32(phy_off);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002398 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(phy_off),
Zhu Yi2638bc32006-01-24 16:37:52 +08002399 &phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002400}
James Ketrenos43f66a62005-03-25 12:31:53 -06002401
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002402static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002403{
James Ketrenos43f66a62005-03-25 12:31:53 -06002404 if (!priv || !power) {
2405 IPW_ERROR("Invalid args\n");
2406 return -1;
2407 }
2408
Zhu Yi2638bc32006-01-24 16:37:52 +08002409 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002410}
James Ketrenos43f66a62005-03-25 12:31:53 -06002411
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002412static int ipw_set_tx_power(struct ipw_priv *priv)
2413{
Larry Finger1867b112006-02-28 09:48:28 -06002414 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002415 struct ipw_tx_power tx_power;
2416 s8 max_power;
2417 int i;
2418
2419 memset(&tx_power, 0, sizeof(tx_power));
2420
2421 /* configure device for 'G' band */
2422 tx_power.ieee_mode = IPW_G_MODE;
2423 tx_power.num_channels = geo->bg_channels;
2424 for (i = 0; i < geo->bg_channels; i++) {
2425 max_power = geo->bg[i].max_power;
2426 tx_power.channels_tx_power[i].channel_number =
2427 geo->bg[i].channel;
2428 tx_power.channels_tx_power[i].tx_power = max_power ?
2429 min(max_power, priv->tx_power) : priv->tx_power;
2430 }
2431 if (ipw_send_tx_power(priv, &tx_power))
2432 return -EIO;
2433
2434 /* configure device to also handle 'B' band */
2435 tx_power.ieee_mode = IPW_B_MODE;
2436 if (ipw_send_tx_power(priv, &tx_power))
2437 return -EIO;
2438
2439 /* configure device to also handle 'A' band */
2440 if (priv->ieee->abg_true) {
2441 tx_power.ieee_mode = IPW_A_MODE;
2442 tx_power.num_channels = geo->a_channels;
2443 for (i = 0; i < tx_power.num_channels; i++) {
2444 max_power = geo->a[i].max_power;
2445 tx_power.channels_tx_power[i].channel_number =
2446 geo->a[i].channel;
2447 tx_power.channels_tx_power[i].tx_power = max_power ?
2448 min(max_power, priv->tx_power) : priv->tx_power;
2449 }
2450 if (ipw_send_tx_power(priv, &tx_power))
2451 return -EIO;
2452 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002453 return 0;
2454}
2455
2456static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2457{
2458 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002459 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002460 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002461
2462 if (!priv) {
2463 IPW_ERROR("Invalid args\n");
2464 return -1;
2465 }
2466
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002467 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2468 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002469}
2470
2471static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2472{
2473 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002474 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002475 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002476
2477 if (!priv) {
2478 IPW_ERROR("Invalid args\n");
2479 return -1;
2480 }
2481
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002482 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2483 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002484}
2485
2486static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2487{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002488 u32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002489
2490 if (!priv) {
2491 IPW_ERROR("Invalid args\n");
2492 return -1;
2493 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002494
James Ketrenos43f66a62005-03-25 12:31:53 -06002495 /* If on battery, set to 3, if AC set to CAM, else user
2496 * level */
2497 switch (mode) {
2498 case IPW_POWER_BATTERY:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002499 param = IPW_POWER_INDEX_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06002500 break;
2501 case IPW_POWER_AC:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002502 param = IPW_POWER_MODE_CAM;
James Ketrenos43f66a62005-03-25 12:31:53 -06002503 break;
2504 default:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002505 param = mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06002506 break;
2507 }
2508
Zhu Yi851ca262006-08-21 11:37:58 +08002509 param = cpu_to_le32(mode);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002510 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002511 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002512}
2513
James Ketrenosafbf30a2005-08-25 00:05:33 -05002514static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2515{
2516 struct ipw_retry_limit retry_limit = {
2517 .short_retry_limit = slimit,
2518 .long_retry_limit = llimit
2519 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002520
2521 if (!priv) {
2522 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002523 return -1;
2524 }
2525
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002526 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002527 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002528}
2529
2530/*
2531 * The IPW device contains a Microwire compatible EEPROM that stores
2532 * various data like the MAC address. Usually the firmware has exclusive
2533 * access to the eeprom, but during device initialization (before the
2534 * device driver has sent the HostComplete command to the firmware) the
2535 * device driver has read access to the EEPROM by way of indirect addressing
2536 * through a couple of memory mapped registers.
2537 *
2538 * The following is a simplified implementation for pulling data out of the
2539 * the eeprom, along with some helper functions to find information in
2540 * the per device private data's copy of the eeprom.
2541 *
2542 * NOTE: To better understand how these functions work (i.e what is a chip
2543 * select and why do have to keep driving the eeprom clock?), read
2544 * just about any data sheet for a Microwire compatible EEPROM.
2545 */
2546
2547/* write a 32 bit value into the indirect accessor register */
2548static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2549{
2550 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002551
James Ketrenos43f66a62005-03-25 12:31:53 -06002552 /* the eeprom requires some time to complete the operation */
2553 udelay(p->eeprom_delay);
2554
2555 return;
2556}
2557
2558/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002559static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002560{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002561 eeprom_write_reg(priv, 0);
2562 eeprom_write_reg(priv, EEPROM_BIT_CS);
2563 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2564 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002565}
2566
2567/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002568static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002569{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002570 eeprom_write_reg(priv, EEPROM_BIT_CS);
2571 eeprom_write_reg(priv, 0);
2572 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002573}
2574
2575/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002576static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002577{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002578 int d = (bit ? EEPROM_BIT_DI : 0);
2579 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2580 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002581}
2582
2583/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002584static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002585{
2586 int i;
2587
2588 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002589 eeprom_write_bit(priv, 1);
2590 eeprom_write_bit(priv, op & 2);
2591 eeprom_write_bit(priv, op & 1);
2592 for (i = 7; i >= 0; i--) {
2593 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002594 }
2595}
2596
2597/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002598static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002599{
2600 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002601 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002602
James Ketrenos43f66a62005-03-25 12:31:53 -06002603 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002604 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002605
2606 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002607 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002608
2609 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002610 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002611 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002612 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2613 eeprom_write_reg(priv, EEPROM_BIT_CS);
2614 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2615 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002616 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002617
James Ketrenos43f66a62005-03-25 12:31:53 -06002618 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002619 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002620 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002621
James Ketrenos43f66a62005-03-25 12:31:53 -06002622 return r;
2623}
2624
2625/* helper function for pulling the mac address out of the private */
2626/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002627static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002628{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002629 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002630}
2631
2632/*
2633 * Either the device driver (i.e. the host) or the firmware can
2634 * load eeprom data into the designated region in SRAM. If neither
2635 * happens then the FW will shutdown with a fatal error.
2636 *
2637 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2638 * bit needs region of shared SRAM needs to be non-zero.
2639 */
2640static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2641{
2642 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002643 u16 *eeprom = (u16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002644
James Ketrenos43f66a62005-03-25 12:31:53 -06002645 IPW_DEBUG_TRACE(">>\n");
2646
2647 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002648 for (i = 0; i < 128; i++)
James Ketrenosa613bff2005-08-24 21:43:11 -05002649 eeprom[i] = le16_to_cpu(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002650
Jeff Garzikbf794512005-07-31 13:07:26 -04002651 /*
2652 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002653 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002654 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002655 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002656 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002657 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2658
2659 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002660 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002661 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002662
2663 /* Do not load eeprom data on fatal error or suspend */
2664 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2665 } else {
2666 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2667
2668 /* Load eeprom data on fatal error or suspend */
2669 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2670 }
2671
2672 IPW_DEBUG_TRACE("<<\n");
2673}
2674
Arjan van de Ven858119e2006-01-14 13:20:43 -08002675static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002676{
2677 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002678 if (!count)
2679 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002680 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002681 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002682 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002683}
2684
2685static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2686{
James Ketrenosb095c382005-08-24 22:04:42 -05002687 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002688 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002689 sizeof(struct command_block));
2690}
2691
2692static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002693{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002694
2695 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002696
James Ketrenos43f66a62005-03-25 12:31:53 -06002697 /* Start the dma */
2698 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002699
James Ketrenos43f66a62005-03-25 12:31:53 -06002700 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002701 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002702
2703 IPW_DEBUG_FW("<< : \n");
2704 return 0;
2705}
2706
2707static void ipw_fw_dma_abort(struct ipw_priv *priv)
2708{
2709 u32 control = 0;
2710
2711 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002712
Pavel Machek67fd6b42006-07-11 15:34:05 +02002713 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002714 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002715 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002716 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002717
James Ketrenos43f66a62005-03-25 12:31:53 -06002718 IPW_DEBUG_FW("<< \n");
2719}
2720
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002721static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2722 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002723{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002724 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002725 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002726 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002727 IPW_DEBUG_FW(">> :\n");
2728
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002729 ipw_write_indirect(priv, address, (u8 *) cb,
2730 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002731
2732 IPW_DEBUG_FW("<< :\n");
2733 return 0;
2734
2735}
2736
2737static int ipw_fw_dma_kick(struct ipw_priv *priv)
2738{
2739 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002740 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002741
2742 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002743
James Ketrenos43f66a62005-03-25 12:31:53 -06002744 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002745 ipw_fw_dma_write_command_block(priv, index,
2746 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002747
2748 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002749 ipw_clear_bit(priv, IPW_RESET_REG,
2750 IPW_RESET_REG_MASTER_DISABLED |
2751 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002752
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002753 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002754 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002755 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002756
2757 IPW_DEBUG_FW("<< :\n");
2758 return 0;
2759}
2760
2761static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2762{
2763 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002764 u32 register_value = 0;
2765 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002766
2767 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002768 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002769 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002770
2771 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002772 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2773 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002774
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002775 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002776 cb_fields_address = address;
2777 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002778 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002779
2780 cb_fields_address += sizeof(u32);
2781 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002782 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002783
2784 cb_fields_address += sizeof(u32);
2785 register_value = ipw_read_reg32(priv, cb_fields_address);
2786 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2787 register_value);
2788
2789 cb_fields_address += sizeof(u32);
2790 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002791 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002792
2793 IPW_DEBUG_FW(">> :\n");
2794}
2795
2796static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2797{
2798 u32 current_cb_address = 0;
2799 u32 current_cb_index = 0;
2800
2801 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002802 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002803
James Ketrenosb095c382005-08-24 22:04:42 -05002804 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002805 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002806
James Ketrenos43f66a62005-03-25 12:31:53 -06002807 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002808 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002809
2810 IPW_DEBUG_FW(">> :\n");
2811 return current_cb_index;
2812
2813}
2814
2815static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2816 u32 src_address,
2817 u32 dest_address,
2818 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002819 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002820{
2821
Jeff Garzikbf794512005-07-31 13:07:26 -04002822 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002823 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2824 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002825 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002826 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002827
2828 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2829 src_address, dest_address, length);
2830
2831 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2832 return -1;
2833
2834 last_cb_element = priv->sram_desc.last_cb_index;
2835 cb = &priv->sram_desc.cb_list[last_cb_element];
2836 priv->sram_desc.last_cb_index++;
2837
2838 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002839 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002840 control |= CB_INT_ENABLED;
2841
2842 if (is_last)
2843 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002844
James Ketrenos43f66a62005-03-25 12:31:53 -06002845 control |= length;
2846
2847 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002848 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002849
2850 /* Copy the Source and Destination addresses */
2851 cb->dest_addr = dest_address;
2852 cb->source_addr = src_address;
2853
2854 /* Copy the Control Word last */
2855 cb->control = control;
2856
2857 return 0;
2858}
2859
2860static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002861 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002862{
2863 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002864 u32 src_offset = 0;
2865 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002866 int status = 0;
2867 IPW_DEBUG_FW(">> \n");
2868 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2869 src_phys, dest_address, length);
2870 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002871 status = ipw_fw_dma_add_command_block(priv,
2872 src_phys + src_offset,
2873 dest_address +
2874 dest_offset,
2875 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002876 if (status) {
2877 IPW_DEBUG_FW_INFO(": Failed\n");
2878 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002879 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002880 IPW_DEBUG_FW_INFO(": Added new cb\n");
2881
2882 src_offset += CB_MAX_LENGTH;
2883 dest_offset += CB_MAX_LENGTH;
2884 bytes_left -= CB_MAX_LENGTH;
2885 }
2886
2887 /* add the buffer tail */
2888 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002889 status =
2890 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2891 dest_address + dest_offset,
2892 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002893 if (status) {
2894 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2895 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002896 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002897 IPW_DEBUG_FW_INFO
2898 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002899 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002900
James Ketrenos43f66a62005-03-25 12:31:53 -06002901 IPW_DEBUG_FW("<< \n");
2902 return 0;
2903}
2904
2905static int ipw_fw_dma_wait(struct ipw_priv *priv)
2906{
Zhu Yi397ae122006-01-24 16:37:22 +08002907 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002908 u32 watchdog = 0;
2909
2910 IPW_DEBUG_FW(">> : \n");
2911
2912 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002913 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002914 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002915
2916 while (current_index < priv->sram_desc.last_cb_index) {
2917 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002918 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002919 current_index = ipw_fw_dma_command_block_index(priv);
2920
Zhu Yi397ae122006-01-24 16:37:22 +08002921 if (previous_index < current_index) {
2922 watchdog = 0;
2923 continue;
2924 }
2925 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002926 IPW_DEBUG_FW_INFO("Timeout\n");
2927 ipw_fw_dma_dump_command_block(priv);
2928 ipw_fw_dma_abort(priv);
2929 return -1;
2930 }
2931 }
2932
2933 ipw_fw_dma_abort(priv);
2934
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002935 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002936 ipw_set_bit(priv, IPW_RESET_REG,
2937 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002938
2939 IPW_DEBUG_FW("<< dmaWaitSync \n");
2940 return 0;
2941}
2942
Jeff Garzikbf794512005-07-31 13:07:26 -04002943static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002944{
2945 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002946 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002947 unsigned long flags;
2948
2949 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002950 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2951 network = list_entry(element, struct ieee80211_network, list);
2952 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2953 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002954 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002955 &priv->ieee->network_free_list);
2956 }
2957 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002958 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002959}
2960
2961/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002962 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002963 * Reads debug register from domain0.
2964 * If card is present, pre-defined value should
2965 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002966 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002967 * @param priv
2968 * @return 1 if card is present, 0 otherwise
2969 */
2970static inline int ipw_alive(struct ipw_priv *priv)
2971{
2972 return ipw_read32(priv, 0x90) == 0xd55555d5;
2973}
2974
Zhu Yic7b6a672006-01-24 16:37:05 +08002975/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002976static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002977 int timeout)
2978{
2979 int i = 0;
2980
2981 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002982 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002983 return i;
2984 mdelay(10);
2985 i += 10;
2986 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04002987
James Ketrenos43f66a62005-03-25 12:31:53 -06002988 return -ETIME;
2989}
2990
Jeff Garzikbf794512005-07-31 13:07:26 -04002991/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06002992 * the ipw hardware. It assumes the buffer has all the bits for the
2993 * image and the caller is handling the memory allocation and clean up.
2994 */
2995
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002996static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002997{
2998 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002999
James Ketrenos43f66a62005-03-25 12:31:53 -06003000 IPW_DEBUG_TRACE(">> \n");
3001 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05003002 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003003
Zhu Yic7b6a672006-01-24 16:37:05 +08003004 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05003005 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3006 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06003007 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003008 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003009 return -1;
3010 }
3011
3012 IPW_DEBUG_INFO("stop master %dms\n", rc);
3013
3014 return rc;
3015}
3016
3017static void ipw_arc_release(struct ipw_priv *priv)
3018{
3019 IPW_DEBUG_TRACE(">> \n");
3020 mdelay(5);
3021
James Ketrenosb095c382005-08-24 22:04:42 -05003022 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003023
3024 /* no one knows timing, for safety add some delay */
3025 mdelay(5);
3026}
3027
James Ketrenos43f66a62005-03-25 12:31:53 -06003028struct fw_chunk {
3029 u32 address;
3030 u32 length;
3031};
3032
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003033static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003034{
3035 int rc = 0, i, addr;
3036 u8 cr = 0;
3037 u16 *image;
3038
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003039 image = (u16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04003040
James Ketrenos43f66a62005-03-25 12:31:53 -06003041 IPW_DEBUG_TRACE(">> \n");
3042
3043 rc = ipw_stop_master(priv);
3044
3045 if (rc < 0)
3046 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003047
James Ketrenosb095c382005-08-24 22:04:42 -05003048 for (addr = IPW_SHARED_LOWER_BOUND;
3049 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003050 ipw_write32(priv, addr, 0);
3051 }
3052
3053 /* no ucode (yet) */
3054 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3055 /* destroy DMA queues */
3056 /* reset sequence */
3057
James Ketrenosb095c382005-08-24 22:04:42 -05003058 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003059 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003060 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003061 mdelay(1);
3062
3063 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003064 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003065 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003066
James Ketrenosb095c382005-08-24 22:04:42 -05003067 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003068 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003069
James Ketrenos43f66a62005-03-25 12:31:53 -06003070 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003071 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3072 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003073 mdelay(1);
3074
3075 /* write ucode */
3076 /**
3077 * @bug
3078 * Do NOT set indirect address register once and then
3079 * store data to indirect data register in the loop.
3080 * It seems very reasonable, but in this case DINO do not
3081 * accept ucode. It is essential to set address each time.
3082 */
3083 /* load new ipw uCode */
3084 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003085 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
James Ketrenosa613bff2005-08-24 21:43:11 -05003086 cpu_to_le16(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003087
James Ketrenos43f66a62005-03-25 12:31:53 -06003088 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003089 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3090 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003091
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003092 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003093
3094 /* wait for alive response */
3095 for (i = 0; i < 100; i++) {
3096 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003097 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003098 if (cr & DINO_RXFIFO_DATA)
3099 break;
3100 mdelay(1);
3101 }
3102
3103 if (cr & DINO_RXFIFO_DATA) {
3104 /* alive_command_responce size is NOT multiple of 4 */
3105 u32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003106
3107 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003108 response_buffer[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -05003109 le32_to_cpu(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003110 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003111 memcpy(&priv->dino_alive, response_buffer,
3112 sizeof(priv->dino_alive));
3113 if (priv->dino_alive.alive_command == 1
3114 && priv->dino_alive.ucode_valid == 1) {
3115 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003116 IPW_DEBUG_INFO
3117 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3118 "of %02d/%02d/%02d %02d:%02d\n",
3119 priv->dino_alive.software_revision,
3120 priv->dino_alive.software_revision,
3121 priv->dino_alive.device_identifier,
3122 priv->dino_alive.device_identifier,
3123 priv->dino_alive.time_stamp[0],
3124 priv->dino_alive.time_stamp[1],
3125 priv->dino_alive.time_stamp[2],
3126 priv->dino_alive.time_stamp[3],
3127 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003128 } else {
3129 IPW_DEBUG_INFO("Microcode is not alive\n");
3130 rc = -EINVAL;
3131 }
3132 } else {
3133 IPW_DEBUG_INFO("No alive response from DINO\n");
3134 rc = -ETIME;
3135 }
3136
3137 /* disable DINO, otherwise for some reason
3138 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003139 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003140
James Ketrenos43f66a62005-03-25 12:31:53 -06003141 return rc;
3142}
3143
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003144static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003145{
3146 int rc = -1;
3147 int offset = 0;
3148 struct fw_chunk *chunk;
3149 dma_addr_t shared_phys;
3150 u8 *shared_virt;
3151
3152 IPW_DEBUG_TRACE("<< : \n");
3153 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3154
3155 if (!shared_virt)
3156 return -ENOMEM;
3157
3158 memmove(shared_virt, data, len);
3159
3160 /* Start the Dma */
3161 rc = ipw_fw_dma_enable(priv);
3162
3163 if (priv->sram_desc.last_cb_index > 0) {
3164 /* the DMA is already ready this would be a bug. */
3165 BUG();
3166 goto out;
3167 }
3168
3169 do {
3170 chunk = (struct fw_chunk *)(data + offset);
3171 offset += sizeof(struct fw_chunk);
3172 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003173 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003174 * offeset*/
3175 /* Dma loading */
3176 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003177 le32_to_cpu(chunk->address),
3178 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003179 if (rc) {
3180 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3181 goto out;
3182 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003183
James Ketrenosa613bff2005-08-24 21:43:11 -05003184 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003185 } while (offset < len);
3186
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003187 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003188 rc = ipw_fw_dma_kick(priv);
3189 if (rc) {
3190 IPW_ERROR("dmaKick Failed\n");
3191 goto out;
3192 }
3193
3194 rc = ipw_fw_dma_wait(priv);
3195 if (rc) {
3196 IPW_ERROR("dmaWaitSync Failed\n");
3197 goto out;
3198 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003199 out:
3200 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003201 return rc;
3202}
3203
3204/* stop nic */
3205static int ipw_stop_nic(struct ipw_priv *priv)
3206{
3207 int rc = 0;
3208
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003209 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003210 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003211
James Ketrenosb095c382005-08-24 22:04:42 -05003212 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3213 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003214 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003215 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003216 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003217 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003218
James Ketrenosb095c382005-08-24 22:04:42 -05003219 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003220
James Ketrenos43f66a62005-03-25 12:31:53 -06003221 return rc;
3222}
3223
3224static void ipw_start_nic(struct ipw_priv *priv)
3225{
3226 IPW_DEBUG_TRACE(">>\n");
3227
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003228 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003229 ipw_clear_bit(priv, IPW_RESET_REG,
3230 IPW_RESET_REG_MASTER_DISABLED |
3231 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003232 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003233
James Ketrenos43f66a62005-03-25 12:31:53 -06003234 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003235 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3236 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003237
3238 IPW_DEBUG_TRACE("<<\n");
3239}
Jeff Garzikbf794512005-07-31 13:07:26 -04003240
James Ketrenos43f66a62005-03-25 12:31:53 -06003241static int ipw_init_nic(struct ipw_priv *priv)
3242{
3243 int rc;
3244
3245 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003246 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003247 /*prvHwInitNic */
3248 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003249 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003250
3251 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003252 ipw_write32(priv, IPW_READ_INT_REGISTER,
3253 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003254
3255 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003256 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3257 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003258 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003259 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3260
3261 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003262 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003263
3264 udelay(10);
3265
3266 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003267 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003268
3269 IPW_DEBUG_TRACE(">>\n");
3270 return 0;
3271}
3272
Jeff Garzikbf794512005-07-31 13:07:26 -04003273/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003274 * Probe is an ok place to call this from.
3275 */
3276static int ipw_reset_nic(struct ipw_priv *priv)
3277{
3278 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003279 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003280
3281 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003282
James Ketrenos43f66a62005-03-25 12:31:53 -06003283 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003284
James Ketrenosa613bff2005-08-24 21:43:11 -05003285 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003286 /* Clear the 'host command active' bit... */
3287 priv->status &= ~STATUS_HCMD_ACTIVE;
3288 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003289 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3290 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003291 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003292
3293 IPW_DEBUG_TRACE("<<\n");
3294 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003295}
James Ketrenos43f66a62005-03-25 12:31:53 -06003296
James Ketrenos9006ea72006-03-08 03:22:28 +08003297
3298struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003299 __le32 ver;
3300 __le32 boot_size;
3301 __le32 ucode_size;
3302 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003303 u8 data[0];
3304};
3305
Jeff Garzikbf794512005-07-31 13:07:26 -04003306static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003307 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003308{
James Ketrenos9006ea72006-03-08 03:22:28 +08003309 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003310 int rc;
3311
3312 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003313 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003314 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003315 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003316 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003317 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003318
James Ketrenos9006ea72006-03-08 03:22:28 +08003319 if ((*raw)->size < sizeof(*fw)) {
3320 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003321 return -EINVAL;
3322 }
3323
James Ketrenos9006ea72006-03-08 03:22:28 +08003324 fw = (void *)(*raw)->data;
3325
Zhu Yi0070f8c2006-04-13 17:20:12 +08003326 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3327 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003328 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3329 name, (*raw)->size);
3330 return -EINVAL;
3331 }
3332
3333 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003334 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003335 le32_to_cpu(fw->ver) >> 16,
3336 le32_to_cpu(fw->ver) & 0xff,
3337 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003338 return 0;
3339}
3340
James Ketrenosb095c382005-08-24 22:04:42 -05003341#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003342
Arjan van de Ven858119e2006-01-14 13:20:43 -08003343static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003344 struct ipw_rx_queue *rxq)
3345{
3346 unsigned long flags;
3347 int i;
3348
3349 spin_lock_irqsave(&rxq->lock, flags);
3350
3351 INIT_LIST_HEAD(&rxq->rx_free);
3352 INIT_LIST_HEAD(&rxq->rx_used);
3353
3354 /* Fill the rx_used queue with _all_ of the Rx buffers */
3355 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3356 /* In the reset function, these buffers may have been allocated
3357 * to an SKB, so we need to unmap and free potential storage */
3358 if (rxq->pool[i].skb != NULL) {
3359 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003360 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003361 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003362 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003363 }
3364 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3365 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003366
James Ketrenos43f66a62005-03-25 12:31:53 -06003367 /* Set us so that we have processed and used all buffers, but have
3368 * not restocked the Rx queue with fresh buffers */
3369 rxq->read = rxq->write = 0;
3370 rxq->processed = RX_QUEUE_SIZE - 1;
3371 rxq->free_count = 0;
3372 spin_unlock_irqrestore(&rxq->lock, flags);
3373}
3374
3375#ifdef CONFIG_PM
3376static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003377static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003378
3379static void free_firmware(void)
3380{
3381 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003382 release_firmware(raw);
3383 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003384 fw_loaded = 0;
3385 }
3386}
3387#else
3388#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003389#endif
3390
3391static int ipw_load(struct ipw_priv *priv)
3392{
3393#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003394 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003395#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003396 struct ipw_fw *fw;
3397 u8 *boot_img, *ucode_img, *fw_img;
3398 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003399 int rc = 0, retries = 3;
3400
Zhu Yi397ae122006-01-24 16:37:22 +08003401 switch (priv->ieee->iw_mode) {
3402 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003403 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003404 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003405#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003406 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003407 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003408 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003409#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003410 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003411 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003412 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003413 }
Zhu Yi397ae122006-01-24 16:37:22 +08003414
James Ketrenos9006ea72006-03-08 03:22:28 +08003415 if (!name) {
3416 rc = -EINVAL;
3417 goto error;
3418 }
3419
3420#ifdef CONFIG_PM
3421 if (!fw_loaded) {
3422#endif
3423 rc = ipw_get_fw(priv, &raw, name);
3424 if (rc < 0)
3425 goto error;
3426#ifdef CONFIG_PM
3427 }
3428#endif
3429
3430 fw = (void *)raw->data;
3431 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003432 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3433 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3434 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003435
Zhu Yi397ae122006-01-24 16:37:22 +08003436 if (rc < 0)
3437 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003438
3439 if (!priv->rxq)
3440 priv->rxq = ipw_rx_queue_alloc(priv);
3441 else
3442 ipw_rx_queue_reset(priv, priv->rxq);
3443 if (!priv->rxq) {
3444 IPW_ERROR("Unable to initialize Rx queue\n");
3445 goto error;
3446 }
3447
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003448 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003449 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003450 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003451 priv->status &= ~STATUS_INT_ENABLED;
3452
3453 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003454 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003455
James Ketrenos43f66a62005-03-25 12:31:53 -06003456 ipw_stop_nic(priv);
3457
3458 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003459 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003460 IPW_ERROR("Unable to reset NIC\n");
3461 goto error;
3462 }
3463
James Ketrenosb095c382005-08-24 22:04:42 -05003464 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3465 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003466
3467 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003468 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003469 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003470 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003471 goto error;
3472 }
3473
3474 /* kick start the device */
3475 ipw_start_nic(priv);
3476
Zhu Yic7b6a672006-01-24 16:37:05 +08003477 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003478 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3479 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003480 if (rc < 0) {
3481 IPW_ERROR("device failed to boot initial fw image\n");
3482 goto error;
3483 }
3484 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3485
Jeff Garzikbf794512005-07-31 13:07:26 -04003486 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003487 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003488
3489 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003490 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003491 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003492 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003493 goto error;
3494 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003495
James Ketrenos43f66a62005-03-25 12:31:53 -06003496 /* stop nic */
3497 ipw_stop_nic(priv);
3498
3499 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003500 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003501 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003502 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003503 goto error;
3504 }
Zhu Yi397ae122006-01-24 16:37:22 +08003505#ifdef CONFIG_PM
3506 fw_loaded = 1;
3507#endif
3508
James Ketrenos43f66a62005-03-25 12:31:53 -06003509 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3510
3511 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003512 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003513 IPW_ERROR("Unable to initialize queues\n");
3514 goto error;
3515 }
3516
3517 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003518 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003519 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003520 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003521
James Ketrenos43f66a62005-03-25 12:31:53 -06003522 /* kick start the device */
3523 ipw_start_nic(priv);
3524
James Ketrenosb095c382005-08-24 22:04:42 -05003525 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003526 if (retries > 0) {
3527 IPW_WARNING("Parity error. Retrying init.\n");
3528 retries--;
3529 goto retry;
3530 }
3531
3532 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3533 rc = -EIO;
3534 goto error;
3535 }
3536
3537 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003538 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3539 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003540 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003541 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003542 goto error;
3543 }
3544 IPW_DEBUG_INFO("device response after %dms\n", rc);
3545
3546 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003547 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003548
3549 /* read eeprom data and initialize the eeprom region of sram */
3550 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003551 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003552
3553 /* enable interrupts */
3554 ipw_enable_interrupts(priv);
3555
3556 /* Ensure our queue has valid packets */
3557 ipw_rx_queue_replenish(priv);
3558
James Ketrenosb095c382005-08-24 22:04:42 -05003559 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003560
3561 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003562 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003563
3564#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003565 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003566#endif
3567 return 0;
3568
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003569 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003570 if (priv->rxq) {
3571 ipw_rx_queue_free(priv, priv->rxq);
3572 priv->rxq = NULL;
3573 }
3574 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003575 if (raw)
3576 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003577#ifdef CONFIG_PM
3578 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003579 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003580#endif
3581
3582 return rc;
3583}
3584
Jeff Garzikbf794512005-07-31 13:07:26 -04003585/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003586 * DMA services
3587 *
3588 * Theory of operation
3589 *
3590 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3591 * 2 empty entries always kept in the buffer to protect from overflow.
3592 *
3593 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003594 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3595 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003596 * Tx queue resumed.
3597 *
3598 * The IPW operates with six queues, one receive queue in the device's
3599 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003600 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003601 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003602 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003603 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003604 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003605 * we only utilize the first data transmit queue (queue1).
3606 */
3607
3608/**
3609 * Driver allocates buffers of this size for Rx
3610 */
3611
3612static inline int ipw_queue_space(const struct clx2_queue *q)
3613{
3614 int s = q->last_used - q->first_empty;
3615 if (s <= 0)
3616 s += q->n_bd;
3617 s -= 2; /* keep some reserve to not confuse empty and full situations */
3618 if (s < 0)
3619 s = 0;
3620 return s;
3621}
3622
3623static inline int ipw_queue_inc_wrap(int index, int n_bd)
3624{
3625 return (++index == n_bd) ? 0 : index;
3626}
3627
3628/**
3629 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003630 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003631 * @param q queue to init
3632 * @param count Number of BD's to allocate. Should be power of 2
3633 * @param read_register Address for 'read' register
3634 * (not offset within BAR, full address)
3635 * @param write_register Address for 'write' register
3636 * (not offset within BAR, full address)
3637 * @param base_register Address for 'base' register
3638 * (not offset within BAR, full address)
3639 * @param size Address for 'size' register
3640 * (not offset within BAR, full address)
3641 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003642static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003643 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003644{
3645 q->n_bd = count;
3646
3647 q->low_mark = q->n_bd / 4;
3648 if (q->low_mark < 4)
3649 q->low_mark = 4;
3650
3651 q->high_mark = q->n_bd / 8;
3652 if (q->high_mark < 2)
3653 q->high_mark = 2;
3654
3655 q->first_empty = q->last_used = 0;
3656 q->reg_r = read;
3657 q->reg_w = write;
3658
3659 ipw_write32(priv, base, q->dma_addr);
3660 ipw_write32(priv, size, count);
3661 ipw_write32(priv, read, 0);
3662 ipw_write32(priv, write, 0);
3663
3664 _ipw_read32(priv, 0x90);
3665}
3666
Jeff Garzikbf794512005-07-31 13:07:26 -04003667static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003668 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003669 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003670{
3671 struct pci_dev *dev = priv->pci_dev;
3672
3673 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3674 if (!q->txb) {
3675 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3676 return -ENOMEM;
3677 }
3678
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003679 q->bd =
3680 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003681 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003682 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003683 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003684 kfree(q->txb);
3685 q->txb = NULL;
3686 return -ENOMEM;
3687 }
3688
3689 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3690 return 0;
3691}
3692
3693/**
3694 * Free one TFD, those at index [txq->q.last_used].
3695 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003696 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003697 * @param dev
3698 * @param txq
3699 */
3700static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3701 struct clx2_tx_queue *txq)
3702{
3703 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3704 struct pci_dev *dev = priv->pci_dev;
3705 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003706
James Ketrenos43f66a62005-03-25 12:31:53 -06003707 /* classify bd */
3708 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3709 /* nothing to cleanup after for host commands */
3710 return;
3711
3712 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003713 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3714 IPW_ERROR("Too many chunks: %i\n",
3715 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003716 /** @todo issue fatal error, it is quite serious situation */
3717 return;
3718 }
3719
3720 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003721 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3722 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3723 le16_to_cpu(bd->u.data.chunk_len[i]),
3724 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003725 if (txq->txb[txq->q.last_used]) {
3726 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3727 txq->txb[txq->q.last_used] = NULL;
3728 }
3729 }
3730}
3731
3732/**
3733 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003734 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003735 * Empty queue by removing and destroying all BD's.
3736 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003737 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003738 * @param dev
3739 * @param q
3740 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003741static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003742{
3743 struct clx2_queue *q = &txq->q;
3744 struct pci_dev *dev = priv->pci_dev;
3745
Jeff Garzikbf794512005-07-31 13:07:26 -04003746 if (q->n_bd == 0)
3747 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003748
3749 /* first, empty all BD's */
3750 for (; q->first_empty != q->last_used;
3751 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3752 ipw_queue_tx_free_tfd(priv, txq);
3753 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003754
James Ketrenos43f66a62005-03-25 12:31:53 -06003755 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003756 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003757 q->dma_addr);
3758 kfree(txq->txb);
3759
3760 /* 0 fill whole structure */
3761 memset(txq, 0, sizeof(*txq));
3762}
3763
James Ketrenos43f66a62005-03-25 12:31:53 -06003764/**
3765 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003766 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003767 * @param priv
3768 */
3769static void ipw_tx_queue_free(struct ipw_priv *priv)
3770{
3771 /* Tx CMD queue */
3772 ipw_queue_tx_free(priv, &priv->txq_cmd);
3773
3774 /* Tx queues */
3775 ipw_queue_tx_free(priv, &priv->txq[0]);
3776 ipw_queue_tx_free(priv, &priv->txq[1]);
3777 ipw_queue_tx_free(priv, &priv->txq[2]);
3778 ipw_queue_tx_free(priv, &priv->txq[3]);
3779}
3780
Arjan van de Ven858119e2006-01-14 13:20:43 -08003781static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003782{
3783 /* First 3 bytes are manufacturer */
3784 bssid[0] = priv->mac_addr[0];
3785 bssid[1] = priv->mac_addr[1];
3786 bssid[2] = priv->mac_addr[2];
3787
3788 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003789 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003790
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003791 bssid[0] &= 0xfe; /* clear multicast bit */
3792 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003793}
3794
Arjan van de Ven858119e2006-01-14 13:20:43 -08003795static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003796{
3797 struct ipw_station_entry entry;
3798 int i;
3799
3800 for (i = 0; i < priv->num_stations; i++) {
3801 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3802 /* Another node is active in network */
3803 priv->missed_adhoc_beacons = 0;
3804 if (!(priv->config & CFG_STATIC_CHANNEL))
3805 /* when other nodes drop out, we drop out */
3806 priv->config &= ~CFG_ADHOC_PERSIST;
3807
3808 return i;
3809 }
3810 }
3811
3812 if (i == MAX_STATIONS)
3813 return IPW_INVALID_STATION;
3814
3815 IPW_DEBUG_SCAN("Adding AdHoc station: " MAC_FMT "\n", MAC_ARG(bssid));
3816
3817 entry.reserved = 0;
3818 entry.support_mode = 0;
3819 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3820 memcpy(priv->stations[i], bssid, ETH_ALEN);
3821 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003822 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003823 priv->num_stations++;
3824
3825 return i;
3826}
3827
Arjan van de Ven858119e2006-01-14 13:20:43 -08003828static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003829{
3830 int i;
3831
Jeff Garzikbf794512005-07-31 13:07:26 -04003832 for (i = 0; i < priv->num_stations; i++)
3833 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003834 return i;
3835
3836 return IPW_INVALID_STATION;
3837}
3838
3839static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3840{
3841 int err;
3842
Hong Liu7b996592005-08-25 17:36:13 +08003843 if (priv->status & STATUS_ASSOCIATING) {
3844 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3845 queue_work(priv->workqueue, &priv->disassociate);
3846 return;
3847 }
3848
3849 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003850 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3851 return;
3852 }
3853
3854 IPW_DEBUG_ASSOC("Disassocation attempt from " MAC_FMT " "
3855 "on channel %d.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04003856 MAC_ARG(priv->assoc_request.bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06003857 priv->assoc_request.channel);
3858
3859 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3860 priv->status |= STATUS_DISASSOCIATING;
3861
3862 if (quiet)
3863 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3864 else
3865 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003866
James Ketrenos43f66a62005-03-25 12:31:53 -06003867 err = ipw_send_associate(priv, &priv->assoc_request);
3868 if (err) {
3869 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3870 "failed.\n");
3871 return;
3872 }
3873
3874}
3875
James Ketrenosc848d0a2005-08-24 21:56:24 -05003876static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003877{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003878 struct ipw_priv *priv = data;
3879 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3880 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003881 ipw_send_disassociate(data, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003882 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003883}
3884
David Howellsc4028952006-11-22 14:57:56 +00003885static void ipw_bg_disassociate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06003886{
David Howellsc4028952006-11-22 14:57:56 +00003887 struct ipw_priv *priv =
3888 container_of(work, struct ipw_priv, disassociate);
Zhu Yi46441512006-01-24 16:37:59 +08003889 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00003890 ipw_disassociate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08003891 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003892}
3893
David Howellsc4028952006-11-22 14:57:56 +00003894static void ipw_system_config(struct work_struct *work)
Zhu Yid8bad6d2005-07-13 12:25:38 -05003895{
David Howellsc4028952006-11-22 14:57:56 +00003896 struct ipw_priv *priv =
3897 container_of(work, struct ipw_priv, system_config);
Zhu Yid685b8c2006-04-13 17:20:27 +08003898
3899#ifdef CONFIG_IPW2200_PROMISCUOUS
3900 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3901 priv->sys_config.accept_all_data_frames = 1;
3902 priv->sys_config.accept_non_directed_frames = 1;
3903 priv->sys_config.accept_all_mgmt_bcpr = 1;
3904 priv->sys_config.accept_all_mgmt_frames = 1;
3905 }
3906#endif
3907
3908 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003909}
3910
3911struct ipw_status_code {
3912 u16 status;
3913 const char *reason;
3914};
3915
3916static const struct ipw_status_code ipw_status_codes[] = {
3917 {0x00, "Successful"},
3918 {0x01, "Unspecified failure"},
3919 {0x0A, "Cannot support all requested capabilities in the "
3920 "Capability information field"},
3921 {0x0B, "Reassociation denied due to inability to confirm that "
3922 "association exists"},
3923 {0x0C, "Association denied due to reason outside the scope of this "
3924 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003925 {0x0D,
3926 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003927 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003928 {0x0E,
3929 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003930 "transaction sequence number out of expected sequence"},
3931 {0x0F, "Authentication rejected because of challenge failure"},
3932 {0x10, "Authentication rejected due to timeout waiting for next "
3933 "frame in sequence"},
3934 {0x11, "Association denied because AP is unable to handle additional "
3935 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003936 {0x12,
3937 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003938 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003939 {0x13,
3940 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003941 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003942 {0x14,
3943 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003944 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003945 {0x15,
3946 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003947 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003948 {0x19,
3949 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003950 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003951 {0x1A,
3952 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003953 "DSSS-OFDM operation"},
3954 {0x28, "Invalid Information Element"},
3955 {0x29, "Group Cipher is not valid"},
3956 {0x2A, "Pairwise Cipher is not valid"},
3957 {0x2B, "AKMP is not valid"},
3958 {0x2C, "Unsupported RSN IE version"},
3959 {0x2D, "Invalid RSN IE Capabilities"},
3960 {0x2E, "Cipher suite is rejected per security policy"},
3961};
3962
Jeff Garzikbf794512005-07-31 13:07:26 -04003963static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003964{
3965 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003966 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003967 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003968 return ipw_status_codes[i].reason;
3969 return "Unknown status value.";
3970}
James Ketrenos43f66a62005-03-25 12:31:53 -06003971
3972static void inline average_init(struct average *avg)
3973{
3974 memset(avg, 0, sizeof(*avg));
3975}
3976
Zhu Yi00d21de2006-04-13 17:19:02 +08003977#define DEPTH_RSSI 8
3978#define DEPTH_NOISE 16
3979static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
3980{
3981 return ((depth-1)*prev_avg + val)/depth;
3982}
3983
Arjan van de Ven858119e2006-01-14 13:20:43 -08003984static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06003985{
3986 avg->sum -= avg->entries[avg->pos];
3987 avg->sum += val;
3988 avg->entries[avg->pos++] = val;
3989 if (unlikely(avg->pos == AVG_ENTRIES)) {
3990 avg->init = 1;
3991 avg->pos = 0;
3992 }
3993}
3994
Arjan van de Ven858119e2006-01-14 13:20:43 -08003995static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06003996{
3997 if (!unlikely(avg->init)) {
3998 if (avg->pos)
3999 return avg->sum / avg->pos;
4000 return 0;
4001 }
4002
4003 return avg->sum / AVG_ENTRIES;
4004}
4005
4006static void ipw_reset_stats(struct ipw_priv *priv)
4007{
4008 u32 len = sizeof(u32);
4009
4010 priv->quality = 0;
4011
4012 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08004013 priv->exp_avg_rssi = -60;
4014 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06004015
4016 priv->last_rate = 0;
4017 priv->last_missed_beacons = 0;
4018 priv->last_rx_packets = 0;
4019 priv->last_tx_packets = 0;
4020 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04004021
James Ketrenos43f66a62005-03-25 12:31:53 -06004022 /* Firmware managed, reset only when NIC is restarted, so we have to
4023 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04004024 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06004025 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04004026 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06004027 &priv->last_tx_failures, &len);
4028
4029 /* Driver managed, reset with each association */
4030 priv->missed_adhoc_beacons = 0;
4031 priv->missed_beacons = 0;
4032 priv->tx_packets = 0;
4033 priv->rx_packets = 0;
4034
4035}
4036
Arjan van de Ven858119e2006-01-14 13:20:43 -08004037static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06004038{
4039 u32 i = 0x80000000;
4040 u32 mask = priv->rates_mask;
4041 /* If currently associated in B mode, restrict the maximum
4042 * rate match to B rates */
4043 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
4044 mask &= IEEE80211_CCK_RATES_MASK;
4045
4046 /* TODO: Verify that the rate is supported by the current rates
4047 * list. */
4048
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004049 while (i && !(mask & i))
4050 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06004051 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004052 case IEEE80211_CCK_RATE_1MB_MASK:
4053 return 1000000;
4054 case IEEE80211_CCK_RATE_2MB_MASK:
4055 return 2000000;
4056 case IEEE80211_CCK_RATE_5MB_MASK:
4057 return 5500000;
4058 case IEEE80211_OFDM_RATE_6MB_MASK:
4059 return 6000000;
4060 case IEEE80211_OFDM_RATE_9MB_MASK:
4061 return 9000000;
4062 case IEEE80211_CCK_RATE_11MB_MASK:
4063 return 11000000;
4064 case IEEE80211_OFDM_RATE_12MB_MASK:
4065 return 12000000;
4066 case IEEE80211_OFDM_RATE_18MB_MASK:
4067 return 18000000;
4068 case IEEE80211_OFDM_RATE_24MB_MASK:
4069 return 24000000;
4070 case IEEE80211_OFDM_RATE_36MB_MASK:
4071 return 36000000;
4072 case IEEE80211_OFDM_RATE_48MB_MASK:
4073 return 48000000;
4074 case IEEE80211_OFDM_RATE_54MB_MASK:
4075 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004076 }
4077
Jeff Garzikbf794512005-07-31 13:07:26 -04004078 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004079 return 11000000;
4080 else
4081 return 54000000;
4082}
4083
4084static u32 ipw_get_current_rate(struct ipw_priv *priv)
4085{
4086 u32 rate, len = sizeof(rate);
4087 int err;
4088
Jeff Garzikbf794512005-07-31 13:07:26 -04004089 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004090 return 0;
4091
4092 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004093 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004094 &len);
4095 if (err) {
4096 IPW_DEBUG_INFO("failed querying ordinals.\n");
4097 return 0;
4098 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004099 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004100 return ipw_get_max_rate(priv);
4101
4102 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004103 case IPW_TX_RATE_1MB:
4104 return 1000000;
4105 case IPW_TX_RATE_2MB:
4106 return 2000000;
4107 case IPW_TX_RATE_5MB:
4108 return 5500000;
4109 case IPW_TX_RATE_6MB:
4110 return 6000000;
4111 case IPW_TX_RATE_9MB:
4112 return 9000000;
4113 case IPW_TX_RATE_11MB:
4114 return 11000000;
4115 case IPW_TX_RATE_12MB:
4116 return 12000000;
4117 case IPW_TX_RATE_18MB:
4118 return 18000000;
4119 case IPW_TX_RATE_24MB:
4120 return 24000000;
4121 case IPW_TX_RATE_36MB:
4122 return 36000000;
4123 case IPW_TX_RATE_48MB:
4124 return 48000000;
4125 case IPW_TX_RATE_54MB:
4126 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004127 }
4128
4129 return 0;
4130}
4131
James Ketrenos43f66a62005-03-25 12:31:53 -06004132#define IPW_STATS_INTERVAL (2 * HZ)
4133static void ipw_gather_stats(struct ipw_priv *priv)
4134{
4135 u32 rx_err, rx_err_delta, rx_packets_delta;
4136 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4137 u32 missed_beacons_percent, missed_beacons_delta;
4138 u32 quality = 0;
4139 u32 len = sizeof(u32);
4140 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004141 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004142 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004143 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004144
4145 if (!(priv->status & STATUS_ASSOCIATED)) {
4146 priv->quality = 0;
4147 return;
4148 }
4149
4150 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004151 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004152 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004153 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004154 priv->last_missed_beacons = priv->missed_beacons;
4155 if (priv->assoc_request.beacon_interval) {
4156 missed_beacons_percent = missed_beacons_delta *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004157 (HZ * priv->assoc_request.beacon_interval) /
4158 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004159 } else {
4160 missed_beacons_percent = 0;
4161 }
4162 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4163
4164 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4165 rx_err_delta = rx_err - priv->last_rx_err;
4166 priv->last_rx_err = rx_err;
4167
4168 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4169 tx_failures_delta = tx_failures - priv->last_tx_failures;
4170 priv->last_tx_failures = tx_failures;
4171
4172 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4173 priv->last_rx_packets = priv->rx_packets;
4174
4175 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4176 priv->last_tx_packets = priv->tx_packets;
4177
4178 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004179 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004180 * Missed beacon: 100% = 0, 0% = 70% missed
4181 * Rate: 60% = 1Mbs, 100% = Max
4182 * Rx and Tx errors represent a straight % of total Rx/Tx
4183 * RSSI: 100% = > -50, 0% = < -80
4184 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004185 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004186 * The lowest computed quality is used.
4187 *
4188 */
4189#define BEACON_THRESHOLD 5
4190 beacon_quality = 100 - missed_beacons_percent;
4191 if (beacon_quality < BEACON_THRESHOLD)
4192 beacon_quality = 0;
4193 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004194 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004195 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004196 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004197 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004198
James Ketrenos43f66a62005-03-25 12:31:53 -06004199 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004200 max_rate = ipw_get_max_rate(priv);
4201 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004202 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4203 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004204
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004205 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004206 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004207 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004208 else
4209 rx_quality = 100;
4210 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4211 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004212
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004213 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004214 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004215 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004216 else
4217 tx_quality = 100;
4218 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4219 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004220
Zhu Yi00d21de2006-04-13 17:19:02 +08004221 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004222 signal_quality =
4223 (100 *
4224 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4225 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4226 (priv->ieee->perfect_rssi - rssi) *
4227 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4228 62 * (priv->ieee->perfect_rssi - rssi))) /
4229 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4230 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4231 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004232 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004233 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004234 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004235
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004236 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004237 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004238
4239 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004240 min(rate_quality,
4241 min(tx_quality, min(rx_quality, signal_quality))));
4242 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004243 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4244 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004245 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004246 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4247 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004248 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004249 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4250 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004251 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004252 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4253 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004254 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004255 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4256 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004257
4258 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004259
4260 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004261 IPW_STATS_INTERVAL);
4262}
4263
David Howellsc4028952006-11-22 14:57:56 +00004264static void ipw_bg_gather_stats(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05004265{
David Howellsc4028952006-11-22 14:57:56 +00004266 struct ipw_priv *priv =
4267 container_of(work, struct ipw_priv, gather_stats.work);
Zhu Yi46441512006-01-24 16:37:59 +08004268 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00004269 ipw_gather_stats(priv);
Zhu Yi46441512006-01-24 16:37:59 +08004270 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004271}
4272
Ben Cahille7582562005-10-06 15:34:41 -05004273/* Missed beacon behavior:
4274 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4275 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4276 * Above disassociate threshold, give up and stop scanning.
4277 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004278static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004279 int missed_count)
4280{
4281 priv->notif_missed_beacons = missed_count;
4282
James Ketrenosafbf30a2005-08-25 00:05:33 -05004283 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004284 priv->status & STATUS_ASSOCIATED) {
4285 /* If associated and we've hit the missed
4286 * beacon threshold, disassociate, turn
4287 * off roaming, and abort any active scans */
4288 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004289 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004290 "Missed beacon: %d - disassociate\n", missed_count);
4291 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004292 if (priv->status & STATUS_SCANNING) {
4293 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4294 IPW_DL_STATE,
4295 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004296 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004297 }
4298
James Ketrenosea2b26e2005-08-24 21:25:16 -05004299 queue_work(priv->workqueue, &priv->disassociate);
4300 return;
4301 }
4302
4303 if (priv->status & STATUS_ROAMING) {
4304 /* If we are currently roaming, then just
4305 * print a debug statement... */
4306 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4307 "Missed beacon: %d - roam in progress\n",
4308 missed_count);
4309 return;
4310 }
4311
Zhu Yi4bfdb912006-01-24 16:37:16 +08004312 if (roaming &&
4313 (missed_count > priv->roaming_threshold &&
4314 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004315 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004316 * bit in the status and kick off a scan.
4317 * This can happen several times before we reach
4318 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004319 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4320 "Missed beacon: %d - initiate "
4321 "roaming\n", missed_count);
4322 if (!(priv->status & STATUS_ROAMING)) {
4323 priv->status |= STATUS_ROAMING;
4324 if (!(priv->status & STATUS_SCANNING))
David Howellsc4028952006-11-22 14:57:56 +00004325 queue_delayed_work(priv->workqueue,
4326 &priv->request_scan, 0);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004327 }
4328 return;
4329 }
4330
4331 if (priv->status & STATUS_SCANNING) {
4332 /* Stop scan to keep fw from getting
4333 * stuck (only if we aren't roaming --
4334 * otherwise we'll never scan more than 2 or 3
4335 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004336 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4337 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004338 queue_work(priv->workqueue, &priv->abort_scan);
4339 }
4340
4341 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004342}
4343
James Ketrenos43f66a62005-03-25 12:31:53 -06004344/**
4345 * Handle host notification packet.
4346 * Called from interrupt routine
4347 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004348static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004349 struct ipw_rx_notification *notif)
4350{
James Ketrenosa613bff2005-08-24 21:43:11 -05004351 notif->size = le16_to_cpu(notif->size);
4352
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004353 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, notif->size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004354
James Ketrenos43f66a62005-03-25 12:31:53 -06004355 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004356 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4357 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004358
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004359 switch (assoc->state) {
4360 case CMAS_ASSOCIATED:{
4361 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4362 IPW_DL_ASSOC,
4363 "associated: '%s' " MAC_FMT
4364 " \n",
4365 escape_essid(priv->essid,
4366 priv->essid_len),
4367 MAC_ARG(priv->bssid));
Jeff Garzikbf794512005-07-31 13:07:26 -04004368
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004369 switch (priv->ieee->iw_mode) {
4370 case IW_MODE_INFRA:
4371 memcpy(priv->ieee->bssid,
4372 priv->bssid, ETH_ALEN);
4373 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004374
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004375 case IW_MODE_ADHOC:
4376 memcpy(priv->ieee->bssid,
4377 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004378
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004379 /* clear out the station table */
4380 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004381
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004382 IPW_DEBUG_ASSOC
4383 ("queueing adhoc check\n");
4384 queue_delayed_work(priv->
4385 workqueue,
4386 &priv->
4387 adhoc_check,
4388 priv->
4389 assoc_request.
4390 beacon_interval);
4391 break;
4392 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004393
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004394 priv->status &= ~STATUS_ASSOCIATING;
4395 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004396 queue_work(priv->workqueue,
4397 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004398
Zhu Yie43e3c12006-04-13 17:20:45 +08004399#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004400#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
4401 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_ctl))
4402 if ((priv->status & STATUS_AUTH) &&
4403 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4404 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004405 if ((sizeof
4406 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004407 ieee80211_assoc_response)
James Ketrenosb095c382005-08-24 22:04:42 -05004408 <= notif->size)
4409 && (notif->size <= 2314)) {
4410 struct
4411 ieee80211_rx_stats
4412 stats = {
4413 .len =
4414 notif->
4415 size - 1,
4416 };
4417
4418 IPW_DEBUG_QOS
4419 ("QoS Associate "
4420 "size %d\n",
4421 notif->size);
4422 ieee80211_rx_mgt(priv->
4423 ieee,
4424 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004425 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004426 *)
4427 &notif->u.raw, &stats);
4428 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004429 }
James Ketrenosb095c382005-08-24 22:04:42 -05004430#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004431
James Ketrenosa613bff2005-08-24 21:43:11 -05004432 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004433
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004434 break;
4435 }
4436
4437 case CMAS_AUTHENTICATED:{
4438 if (priv->
4439 status & (STATUS_ASSOCIATED |
4440 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004441 struct notif_authenticate *auth
4442 = &notif->u.auth;
4443 IPW_DEBUG(IPW_DL_NOTIF |
4444 IPW_DL_STATE |
4445 IPW_DL_ASSOC,
4446 "deauthenticated: '%s' "
4447 MAC_FMT
4448 ": (0x%04X) - %s \n",
4449 escape_essid(priv->
4450 essid,
4451 priv->
4452 essid_len),
4453 MAC_ARG(priv->bssid),
4454 ntohs(auth->status),
4455 ipw_get_status_code
4456 (ntohs
4457 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004458
4459 priv->status &=
4460 ~(STATUS_ASSOCIATING |
4461 STATUS_AUTH |
4462 STATUS_ASSOCIATED);
4463
James Ketrenosa613bff2005-08-24 21:43:11 -05004464 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004465 break;
4466 }
4467
4468 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4469 IPW_DL_ASSOC,
4470 "authenticated: '%s' " MAC_FMT
4471 "\n",
4472 escape_essid(priv->essid,
4473 priv->essid_len),
4474 MAC_ARG(priv->bssid));
4475 break;
4476 }
4477
4478 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004479 if (priv->status & STATUS_AUTH) {
4480 struct
4481 ieee80211_assoc_response
4482 *resp;
4483 resp =
4484 (struct
4485 ieee80211_assoc_response
4486 *)&notif->u.raw;
4487 IPW_DEBUG(IPW_DL_NOTIF |
4488 IPW_DL_STATE |
4489 IPW_DL_ASSOC,
4490 "association failed (0x%04X): %s\n",
4491 ntohs(resp->status),
4492 ipw_get_status_code
4493 (ntohs
4494 (resp->status)));
4495 }
4496
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004497 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4498 IPW_DL_ASSOC,
4499 "disassociated: '%s' " MAC_FMT
4500 " \n",
4501 escape_essid(priv->essid,
4502 priv->essid_len),
4503 MAC_ARG(priv->bssid));
4504
4505 priv->status &=
4506 ~(STATUS_DISASSOCIATING |
4507 STATUS_ASSOCIATING |
4508 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004509 if (priv->assoc_network
4510 && (priv->assoc_network->
4511 capability &
4512 WLAN_CAPABILITY_IBSS))
4513 ipw_remove_current_network
4514 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004515
James Ketrenosa613bff2005-08-24 21:43:11 -05004516 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004517
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004518 break;
4519 }
4520
James Ketrenosb095c382005-08-24 22:04:42 -05004521 case CMAS_RX_ASSOC_RESP:
4522 break;
4523
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004524 default:
4525 IPW_ERROR("assoc: unknown (%d)\n",
4526 assoc->state);
4527 break;
4528 }
4529
James Ketrenos43f66a62005-03-25 12:31:53 -06004530 break;
4531 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004532
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004533 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4534 struct notif_authenticate *auth = &notif->u.auth;
4535 switch (auth->state) {
4536 case CMAS_AUTHENTICATED:
4537 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4538 "authenticated: '%s' " MAC_FMT " \n",
4539 escape_essid(priv->essid,
4540 priv->essid_len),
4541 MAC_ARG(priv->bssid));
4542 priv->status |= STATUS_AUTH;
4543 break;
4544
4545 case CMAS_INIT:
4546 if (priv->status & STATUS_AUTH) {
4547 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4548 IPW_DL_ASSOC,
4549 "authentication failed (0x%04X): %s\n",
4550 ntohs(auth->status),
4551 ipw_get_status_code(ntohs
4552 (auth->
4553 status)));
4554 }
4555 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4556 IPW_DL_ASSOC,
4557 "deauthenticated: '%s' " MAC_FMT "\n",
4558 escape_essid(priv->essid,
4559 priv->essid_len),
4560 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06004561
4562 priv->status &= ~(STATUS_ASSOCIATING |
4563 STATUS_AUTH |
4564 STATUS_ASSOCIATED);
4565
James Ketrenosa613bff2005-08-24 21:43:11 -05004566 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004567 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004568
4569 case CMAS_TX_AUTH_SEQ_1:
4570 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4571 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4572 break;
4573 case CMAS_RX_AUTH_SEQ_2:
4574 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4575 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4576 break;
4577 case CMAS_AUTH_SEQ_1_PASS:
4578 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4579 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4580 break;
4581 case CMAS_AUTH_SEQ_1_FAIL:
4582 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4583 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4584 break;
4585 case CMAS_TX_AUTH_SEQ_3:
4586 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4587 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4588 break;
4589 case CMAS_RX_AUTH_SEQ_4:
4590 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4591 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4592 break;
4593 case CMAS_AUTH_SEQ_2_PASS:
4594 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4595 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4596 break;
4597 case CMAS_AUTH_SEQ_2_FAIL:
4598 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4599 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4600 break;
4601 case CMAS_TX_ASSOC:
4602 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4603 IPW_DL_ASSOC, "TX_ASSOC\n");
4604 break;
4605 case CMAS_RX_ASSOC_RESP:
4606 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4607 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004608
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004609 break;
4610 case CMAS_ASSOCIATED:
4611 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4612 IPW_DL_ASSOC, "ASSOCIATED\n");
4613 break;
4614 default:
4615 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4616 auth->state);
4617 break;
4618 }
4619 break;
4620 }
4621
4622 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4623 struct notif_channel_result *x =
4624 &notif->u.channel_result;
4625
4626 if (notif->size == sizeof(*x)) {
4627 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4628 x->channel_num);
4629 } else {
4630 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4631 "(should be %zd)\n",
4632 notif->size, sizeof(*x));
4633 }
4634 break;
4635 }
4636
4637 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4638 struct notif_scan_complete *x = &notif->u.scan_complete;
4639 if (notif->size == sizeof(*x)) {
4640 IPW_DEBUG_SCAN
4641 ("Scan completed: type %d, %d channels, "
4642 "%d status\n", x->scan_type,
4643 x->num_channels, x->status);
4644 } else {
4645 IPW_ERROR("Scan completed of wrong size %d "
4646 "(should be %zd)\n",
4647 notif->size, sizeof(*x));
4648 }
4649
4650 priv->status &=
4651 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4652
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004653 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004654 cancel_delayed_work(&priv->scan_check);
4655
James Ketrenosb095c382005-08-24 22:04:42 -05004656 if (priv->status & STATUS_EXIT_PENDING)
4657 break;
4658
4659 priv->ieee->scans++;
4660
4661#ifdef CONFIG_IPW2200_MONITOR
4662 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004663 priv->status |= STATUS_SCAN_FORCED;
David Howellsc4028952006-11-22 14:57:56 +00004664 queue_delayed_work(priv->workqueue,
4665 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05004666 break;
4667 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004668 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004669#endif /* CONFIG_IPW2200_MONITOR */
4670
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004671 if (!(priv->status & (STATUS_ASSOCIATED |
4672 STATUS_ASSOCIATING |
4673 STATUS_ROAMING |
4674 STATUS_DISASSOCIATING)))
4675 queue_work(priv->workqueue, &priv->associate);
4676 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004677 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4678 /* If a scan completed and we are in roam mode, then
4679 * the scan that completed was the one requested as a
4680 * result of entering roam... so, schedule the
4681 * roam work */
4682 queue_work(priv->workqueue,
4683 &priv->roam);
4684 else
4685 /* Don't schedule if we aborted the scan */
4686 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004687 } else if (priv->status & STATUS_SCAN_PENDING)
David Howellsc4028952006-11-22 14:57:56 +00004688 queue_delayed_work(priv->workqueue,
4689 &priv->request_scan, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05004690 else if (priv->config & CFG_BACKGROUND_SCAN
4691 && priv->status & STATUS_ASSOCIATED)
4692 queue_delayed_work(priv->workqueue,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07004693 &priv->request_scan,
4694 round_jiffies(HZ));
Zhu Yi07f02e42006-04-13 17:19:25 +08004695
4696 /* Send an empty event to user space.
4697 * We don't send the received data on the event because
4698 * it would require us to do complex transcoding, and
4699 * we want to minimise the work done in the irq handler
4700 * Use a request to extract the data.
4701 * Also, we generate this even for any scan, regardless
4702 * on how the scan was initiated. User space can just
4703 * sync on periodic scan to get fresh data...
4704 * Jean II */
4705 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE) {
4706 union iwreq_data wrqu;
4707
4708 wrqu.data.length = 0;
4709 wrqu.data.flags = 0;
4710 wireless_send_event(priv->net_dev, SIOCGIWSCAN,
4711 &wrqu, NULL);
4712 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004713 break;
4714 }
4715
4716 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4717 struct notif_frag_length *x = &notif->u.frag_len;
4718
James Ketrenosa613bff2005-08-24 21:43:11 -05004719 if (notif->size == sizeof(*x))
4720 IPW_ERROR("Frag length: %d\n",
4721 le16_to_cpu(x->frag_length));
4722 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004723 IPW_ERROR("Frag length of wrong size %d "
4724 "(should be %zd)\n",
4725 notif->size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004726 break;
4727 }
4728
4729 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4730 struct notif_link_deterioration *x =
4731 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004732
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004733 if (notif->size == sizeof(*x)) {
4734 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004735 "link deterioration: type %d, cnt %d\n",
4736 x->silence_notification_type,
4737 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004738 memcpy(&priv->last_link_deterioration, x,
4739 sizeof(*x));
4740 } else {
4741 IPW_ERROR("Link Deterioration of wrong size %d "
4742 "(should be %zd)\n",
4743 notif->size, sizeof(*x));
4744 }
4745 break;
4746 }
4747
4748 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4749 IPW_ERROR("Dino config\n");
4750 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004751 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004752 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004753
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004754 break;
4755 }
4756
4757 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4758 struct notif_beacon_state *x = &notif->u.beacon_state;
4759 if (notif->size != sizeof(*x)) {
4760 IPW_ERROR
4761 ("Beacon state of wrong size %d (should "
4762 "be %zd)\n", notif->size, sizeof(*x));
4763 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004764 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004765
James Ketrenosa613bff2005-08-24 21:43:11 -05004766 if (le32_to_cpu(x->state) ==
4767 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4768 ipw_handle_missed_beacon(priv,
4769 le32_to_cpu(x->
4770 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004771
James Ketrenos43f66a62005-03-25 12:31:53 -06004772 break;
4773 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004774
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004775 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4776 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
4777 if (notif->size == sizeof(*x)) {
4778 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4779 "0x%02x station %d\n",
4780 x->key_state, x->security_type,
4781 x->station_index);
4782 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004783 }
4784
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004785 IPW_ERROR
4786 ("TGi Tx Key of wrong size %d (should be %zd)\n",
4787 notif->size, sizeof(*x));
4788 break;
4789 }
4790
4791 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4792 struct notif_calibration *x = &notif->u.calibration;
4793
4794 if (notif->size == sizeof(*x)) {
4795 memcpy(&priv->calib, x, sizeof(*x));
4796 IPW_DEBUG_INFO("TODO: Calibration\n");
4797 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004798 }
4799
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004800 IPW_ERROR
4801 ("Calibration of wrong size %d (should be %zd)\n",
4802 notif->size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004803 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004804 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004805
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004806 case HOST_NOTIFICATION_NOISE_STATS:{
4807 if (notif->size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004808 priv->exp_avg_noise =
4809 exponential_average(priv->exp_avg_noise,
4810 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4811 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004812 break;
4813 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004814
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004815 IPW_ERROR
4816 ("Noise stat is wrong size %d (should be %zd)\n",
4817 notif->size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004818 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004819 }
4820
James Ketrenos43f66a62005-03-25 12:31:53 -06004821 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004822 IPW_DEBUG_NOTIF("Unknown notification: "
4823 "subtype=%d,flags=0x%2x,size=%d\n",
4824 notif->subtype, notif->flags, notif->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004825 }
4826}
4827
4828/**
4829 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004830 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004831 * @param priv
4832 * @return error code
4833 */
4834static int ipw_queue_reset(struct ipw_priv *priv)
4835{
4836 int rc = 0;
4837 /** @todo customize queue sizes */
4838 int nTx = 64, nTxCmd = 8;
4839 ipw_tx_queue_free(priv);
4840 /* Tx CMD queue */
4841 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004842 IPW_TX_CMD_QUEUE_READ_INDEX,
4843 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4844 IPW_TX_CMD_QUEUE_BD_BASE,
4845 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004846 if (rc) {
4847 IPW_ERROR("Tx Cmd queue init failed\n");
4848 goto error;
4849 }
4850 /* Tx queue(s) */
4851 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004852 IPW_TX_QUEUE_0_READ_INDEX,
4853 IPW_TX_QUEUE_0_WRITE_INDEX,
4854 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004855 if (rc) {
4856 IPW_ERROR("Tx 0 queue init failed\n");
4857 goto error;
4858 }
4859 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004860 IPW_TX_QUEUE_1_READ_INDEX,
4861 IPW_TX_QUEUE_1_WRITE_INDEX,
4862 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 if (rc) {
4864 IPW_ERROR("Tx 1 queue init failed\n");
4865 goto error;
4866 }
4867 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004868 IPW_TX_QUEUE_2_READ_INDEX,
4869 IPW_TX_QUEUE_2_WRITE_INDEX,
4870 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004871 if (rc) {
4872 IPW_ERROR("Tx 2 queue init failed\n");
4873 goto error;
4874 }
4875 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004876 IPW_TX_QUEUE_3_READ_INDEX,
4877 IPW_TX_QUEUE_3_WRITE_INDEX,
4878 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004879 if (rc) {
4880 IPW_ERROR("Tx 3 queue init failed\n");
4881 goto error;
4882 }
4883 /* statistics */
4884 priv->rx_bufs_min = 0;
4885 priv->rx_pend_max = 0;
4886 return rc;
4887
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004888 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004889 ipw_tx_queue_free(priv);
4890 return rc;
4891}
4892
4893/**
4894 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004895 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004896 * When FW adwances 'R' index, all entries between old and
4897 * new 'R' index need to be reclaimed. As result, some free space
4898 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004899 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004900 * @note Need to protect against garbage in 'R' index
4901 * @param priv
4902 * @param txq
4903 * @param qindex
4904 * @return Number of used entries remains in the queue
4905 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004906static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004907 struct clx2_tx_queue *txq, int qindex)
4908{
4909 u32 hw_tail;
4910 int used;
4911 struct clx2_queue *q = &txq->q;
4912
4913 hw_tail = ipw_read32(priv, q->reg_r);
4914 if (hw_tail >= q->n_bd) {
4915 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004916 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4917 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004918 goto done;
4919 }
4920 for (; q->last_used != hw_tail;
4921 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4922 ipw_queue_tx_free_tfd(priv, txq);
4923 priv->tx_packets++;
4924 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004925 done:
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004926 if ((ipw_queue_space(q) > q->low_mark) &&
4927 (qindex >= 0) &&
4928 (priv->status & STATUS_ASSOCIATED) && netif_running(priv->net_dev))
4929 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004930 used = q->first_empty - q->last_used;
4931 if (used < 0)
4932 used += q->n_bd;
4933
4934 return used;
4935}
4936
4937static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4938 int len, int sync)
4939{
4940 struct clx2_tx_queue *txq = &priv->txq_cmd;
4941 struct clx2_queue *q = &txq->q;
4942 struct tfd_frame *tfd;
4943
4944 if (ipw_queue_space(q) < (sync ? 1 : 2)) {
4945 IPW_ERROR("No space for Tx\n");
4946 return -EBUSY;
4947 }
4948
4949 tfd = &txq->bd[q->first_empty];
4950 txq->txb[q->first_empty] = NULL;
4951
4952 memset(tfd, 0, sizeof(*tfd));
4953 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
4954 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
4955 priv->hcmd_seq++;
4956 tfd->u.cmd.index = hcmd;
4957 tfd->u.cmd.length = len;
4958 memcpy(tfd->u.cmd.payload, buf, len);
4959 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
4960 ipw_write32(priv, q->reg_w, q->first_empty);
4961 _ipw_read32(priv, 0x90);
4962
4963 return 0;
4964}
4965
Jeff Garzikbf794512005-07-31 13:07:26 -04004966/*
James Ketrenos43f66a62005-03-25 12:31:53 -06004967 * Rx theory of operation
4968 *
4969 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05004970 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06004971 * 0 to 31
4972 *
4973 * Rx Queue Indexes
4974 * The host/firmware share two index registers for managing the Rx buffers.
4975 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004976 * The READ index maps to the first position that the firmware may be writing
4977 * to -- the driver can read up to (but not including) this position and get
4978 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06004979 * The READ index is managed by the firmware once the card is enabled.
4980 *
4981 * The WRITE index maps to the last position the driver has read from -- the
4982 * position preceding WRITE is the last slot the firmware can place a packet.
4983 *
4984 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04004985 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06004986 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004987 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06004988 * INDEX position, and WRITE to the last (READ - 1 wrapped)
4989 *
4990 * When the firmware places a packet in a buffer it will advance the READ index
4991 * and fire the RX interrupt. The driver can then query the READ index and
4992 * process as many packets as possible, moving the WRITE index forward as it
4993 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04004994 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004995 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04004996 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06004997 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04004998 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06004999 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
5000 * ipw->rxq is replenished and the READ INDEX is updated (updating the
5001 * 'processed' and 'read' driver indexes as well)
5002 * + A received packet is processed and handed to the kernel network stack,
5003 * detached from the ipw->rxq. The driver 'processed' index is updated.
5004 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04005005 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
5006 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06005007 * were enough free buffers and RX_STALLED is set it is cleared.
5008 *
5009 *
5010 * Driver sequence:
5011 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005012 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06005013 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
5014 * ipw_rx_queue_restock
5015 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
5016 * queue, updates firmware pointers, and updates
5017 * the WRITE index. If insufficient rx_free buffers
5018 * are available, schedules ipw_rx_queue_replenish
5019 *
5020 * -- enable interrupts --
5021 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04005022 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06005023 * Moves the packet buffer from queue to rx_used.
5024 * Calls ipw_rx_queue_restock to refill any empty
5025 * slots.
5026 * ...
5027 *
5028 */
5029
Jeff Garzikbf794512005-07-31 13:07:26 -04005030/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005031 * If there are slots in the RX queue that need to be restocked,
5032 * and we have free pre-allocated buffers, fill the ranks as much
5033 * as we can pulling from rx_free.
5034 *
5035 * This moves the 'write' index forward to catch up with 'processed', and
5036 * also updates the memory address in the firmware to reference the new
5037 * target buffer.
5038 */
5039static void ipw_rx_queue_restock(struct ipw_priv *priv)
5040{
5041 struct ipw_rx_queue *rxq = priv->rxq;
5042 struct list_head *element;
5043 struct ipw_rx_mem_buffer *rxb;
5044 unsigned long flags;
5045 int write;
5046
5047 spin_lock_irqsave(&rxq->lock, flags);
5048 write = rxq->write;
5049 while ((rxq->write != rxq->processed) && (rxq->free_count)) {
5050 element = rxq->rx_free.next;
5051 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
5052 list_del(element);
5053
James Ketrenosb095c382005-08-24 22:04:42 -05005054 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005055 rxb->dma_addr);
5056 rxq->queue[rxq->write] = rxb;
5057 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5058 rxq->free_count--;
5059 }
5060 spin_unlock_irqrestore(&rxq->lock, flags);
5061
Jeff Garzikbf794512005-07-31 13:07:26 -04005062 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005063 * refill it */
5064 if (rxq->free_count <= RX_LOW_WATERMARK)
5065 queue_work(priv->workqueue, &priv->rx_replenish);
5066
5067 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005068 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005069 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005070}
5071
5072/*
5073 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005074 * Also restock the Rx queue via ipw_rx_queue_restock.
5075 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005076 * This is called as a scheduled work item (except for during intialization)
5077 */
5078static void ipw_rx_queue_replenish(void *data)
5079{
5080 struct ipw_priv *priv = data;
5081 struct ipw_rx_queue *rxq = priv->rxq;
5082 struct list_head *element;
5083 struct ipw_rx_mem_buffer *rxb;
5084 unsigned long flags;
5085
5086 spin_lock_irqsave(&rxq->lock, flags);
5087 while (!list_empty(&rxq->rx_used)) {
5088 element = rxq->rx_used.next;
5089 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005090 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005091 if (!rxb->skb) {
5092 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5093 priv->net_dev->name);
5094 /* We don't reschedule replenish work here -- we will
5095 * call the restock method and if it still needs
5096 * more buffers it will schedule replenish */
5097 break;
5098 }
5099 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005100
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005101 rxb->dma_addr =
5102 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005103 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005104
James Ketrenos43f66a62005-03-25 12:31:53 -06005105 list_add_tail(&rxb->list, &rxq->rx_free);
5106 rxq->free_count++;
5107 }
5108 spin_unlock_irqrestore(&rxq->lock, flags);
5109
5110 ipw_rx_queue_restock(priv);
5111}
5112
David Howellsc4028952006-11-22 14:57:56 +00005113static void ipw_bg_rx_queue_replenish(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005114{
David Howellsc4028952006-11-22 14:57:56 +00005115 struct ipw_priv *priv =
5116 container_of(work, struct ipw_priv, rx_replenish);
Zhu Yi46441512006-01-24 16:37:59 +08005117 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00005118 ipw_rx_queue_replenish(priv);
Zhu Yi46441512006-01-24 16:37:59 +08005119 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005120}
5121
James Ketrenos43f66a62005-03-25 12:31:53 -06005122/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005123 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005124 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005125 * non NULL it is unmapped and freed
5126 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005127static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005128{
5129 int i;
5130
5131 if (!rxq)
5132 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005133
James Ketrenos43f66a62005-03-25 12:31:53 -06005134 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5135 if (rxq->pool[i].skb != NULL) {
5136 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005137 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005138 dev_kfree_skb(rxq->pool[i].skb);
5139 }
5140 }
5141
5142 kfree(rxq);
5143}
5144
5145static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5146{
5147 struct ipw_rx_queue *rxq;
5148 int i;
5149
Takisc75f4742005-12-01 01:41:45 -08005150 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005151 if (unlikely(!rxq)) {
5152 IPW_ERROR("memory allocation failed\n");
5153 return NULL;
5154 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005155 spin_lock_init(&rxq->lock);
5156 INIT_LIST_HEAD(&rxq->rx_free);
5157 INIT_LIST_HEAD(&rxq->rx_used);
5158
5159 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005160 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005161 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5162
5163 /* Set us so that we have processed and used all buffers, but have
5164 * not restocked the Rx queue with fresh buffers */
5165 rxq->read = rxq->write = 0;
5166 rxq->processed = RX_QUEUE_SIZE - 1;
5167 rxq->free_count = 0;
5168
5169 return rxq;
5170}
5171
5172static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5173{
5174 rate &= ~IEEE80211_BASIC_RATE_MASK;
5175 if (ieee_mode == IEEE_A) {
5176 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005177 case IEEE80211_OFDM_RATE_6MB:
5178 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005179 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005180 case IEEE80211_OFDM_RATE_9MB:
5181 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005182 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005183 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005184 return priv->
5185 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005186 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005187 return priv->
5188 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005189 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005190 return priv->
5191 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005192 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005193 return priv->
5194 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005195 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005196 return priv->
5197 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005198 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005199 return priv->
5200 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005201 default:
5202 return 0;
5203 }
5204 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005205
James Ketrenos43f66a62005-03-25 12:31:53 -06005206 /* B and G mixed */
5207 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005208 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005209 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005210 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005211 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005212 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005213 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005214 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005215 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5216 }
5217
5218 /* If we are limited to B modulations, bail at this point */
5219 if (ieee_mode == IEEE_B)
5220 return 0;
5221
5222 /* G */
5223 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005224 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005225 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005226 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005227 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005228 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005229 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005230 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005231 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005232 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005233 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005234 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005235 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005236 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005237 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005238 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005239 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5240 }
5241
5242 return 0;
5243}
5244
Jeff Garzikbf794512005-07-31 13:07:26 -04005245static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005246 const struct ieee80211_network *network,
5247 struct ipw_supported_rates *rates)
5248{
5249 int num_rates, i;
5250
5251 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005252 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005253 rates->num_rates = 0;
5254 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005255 if (!ipw_is_rate_in_mask(priv, network->mode,
5256 network->rates[i])) {
5257
James Ketrenosea2b26e2005-08-24 21:25:16 -05005258 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005259 IPW_DEBUG_SCAN("Adding masked mandatory "
5260 "rate %02X\n",
5261 network->rates[i]);
5262 rates->supported_rates[rates->num_rates++] =
5263 network->rates[i];
5264 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005265 }
5266
James Ketrenos43f66a62005-03-25 12:31:53 -06005267 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5268 network->rates[i], priv->rates_mask);
5269 continue;
5270 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005271
James Ketrenos43f66a62005-03-25 12:31:53 -06005272 rates->supported_rates[rates->num_rates++] = network->rates[i];
5273 }
5274
James Ketrenosa613bff2005-08-24 21:43:11 -05005275 num_rates = min(network->rates_ex_len,
5276 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005277 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005278 if (!ipw_is_rate_in_mask(priv, network->mode,
5279 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005280 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005281 IPW_DEBUG_SCAN("Adding masked mandatory "
5282 "rate %02X\n",
5283 network->rates_ex[i]);
5284 rates->supported_rates[rates->num_rates++] =
5285 network->rates[i];
5286 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005287 }
5288
James Ketrenos43f66a62005-03-25 12:31:53 -06005289 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5290 network->rates_ex[i], priv->rates_mask);
5291 continue;
5292 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005293
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005294 rates->supported_rates[rates->num_rates++] =
5295 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005296 }
5297
James Ketrenosea2b26e2005-08-24 21:25:16 -05005298 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005299}
5300
Arjan van de Ven858119e2006-01-14 13:20:43 -08005301static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005302 const struct ipw_supported_rates *src)
5303{
5304 u8 i;
5305 for (i = 0; i < src->num_rates; i++)
5306 dest->supported_rates[i] = src->supported_rates[i];
5307 dest->num_rates = src->num_rates;
5308}
5309
5310/* TODO: Look at sniffed packets in the air to determine if the basic rate
5311 * mask should ever be used -- right now all callers to add the scan rates are
5312 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5313static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005314 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005315{
Jeff Garzikbf794512005-07-31 13:07:26 -04005316 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005317 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005318
James Ketrenos43f66a62005-03-25 12:31:53 -06005319 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005320 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005321 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005322
5323 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005324 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005325 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005326
5327 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005328 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005329 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005330
5331 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005332 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005333 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005334}
5335
5336static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005337 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005338{
Jeff Garzikbf794512005-07-31 13:07:26 -04005339 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005340 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005341
5342 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005343 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005344 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005345
5346 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005347 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005348 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005349
5350 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005351 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005352 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005353
5354 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005355 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005356 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005357
5358 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005359 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005360 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005361
5362 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005363 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005364 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005365
5366 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005367 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005368 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005369
5370 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005371 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005372 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005373}
5374
5375struct ipw_network_match {
5376 struct ieee80211_network *network;
5377 struct ipw_supported_rates rates;
5378};
5379
James Ketrenosc848d0a2005-08-24 21:56:24 -05005380static int ipw_find_adhoc_network(struct ipw_priv *priv,
5381 struct ipw_network_match *match,
5382 struct ieee80211_network *network,
5383 int roaming)
5384{
5385 struct ipw_supported_rates rates;
5386
5387 /* Verify that this network's capability is compatible with the
5388 * current mode (AdHoc or Infrastructure) */
5389 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5390 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5391 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded due to "
5392 "capability mismatch.\n",
5393 escape_essid(network->ssid, network->ssid_len),
5394 MAC_ARG(network->bssid));
5395 return 0;
5396 }
5397
5398 /* If we do not have an ESSID for this AP, we can not associate with
5399 * it */
5400 if (network->flags & NETWORK_EMPTY_ESSID) {
5401 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5402 "because of hidden ESSID.\n",
5403 escape_essid(network->ssid, network->ssid_len),
5404 MAC_ARG(network->bssid));
5405 return 0;
5406 }
5407
5408 if (unlikely(roaming)) {
5409 /* If we are roaming, then ensure check if this is a valid
5410 * network to try and roam to */
5411 if ((network->ssid_len != match->network->ssid_len) ||
5412 memcmp(network->ssid, match->network->ssid,
5413 network->ssid_len)) {
5414 IPW_DEBUG_MERGE("Netowrk '%s (" MAC_FMT ")' excluded "
5415 "because of non-network ESSID.\n",
5416 escape_essid(network->ssid,
5417 network->ssid_len),
5418 MAC_ARG(network->bssid));
5419 return 0;
5420 }
5421 } else {
5422 /* If an ESSID has been configured then compare the broadcast
5423 * ESSID to ours */
5424 if ((priv->config & CFG_STATIC_ESSID) &&
5425 ((network->ssid_len != priv->essid_len) ||
5426 memcmp(network->ssid, priv->essid,
5427 min(network->ssid_len, priv->essid_len)))) {
5428 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005429
James Ketrenosc848d0a2005-08-24 21:56:24 -05005430 strncpy(escaped,
5431 escape_essid(network->ssid, network->ssid_len),
5432 sizeof(escaped));
5433 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5434 "because of ESSID mismatch: '%s'.\n",
5435 escaped, MAC_ARG(network->bssid),
5436 escape_essid(priv->essid,
5437 priv->essid_len));
5438 return 0;
5439 }
5440 }
5441
5442 /* If the old network rate is better than this one, don't bother
5443 * testing everything else. */
5444
5445 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005446 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5447 "current network.\n",
5448 escape_essid(match->network->ssid,
5449 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005450 return 0;
5451 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005452 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5453 "current network.\n",
5454 escape_essid(match->network->ssid,
5455 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005456 return 0;
5457 }
5458
5459 /* Now go through and see if the requested network is valid... */
5460 if (priv->ieee->scan_age != 0 &&
5461 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
5462 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005463 "because of age: %ums.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005464 escape_essid(network->ssid, network->ssid_len),
5465 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005466 jiffies_to_msecs(jiffies -
5467 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005468 return 0;
5469 }
5470
5471 if ((priv->config & CFG_STATIC_CHANNEL) &&
5472 (network->channel != priv->channel)) {
5473 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5474 "because of channel mismatch: %d != %d.\n",
5475 escape_essid(network->ssid, network->ssid_len),
5476 MAC_ARG(network->bssid),
5477 network->channel, priv->channel);
5478 return 0;
5479 }
5480
5481 /* Verify privacy compatability */
5482 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5483 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5484 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5485 "because of privacy mismatch: %s != %s.\n",
5486 escape_essid(network->ssid, network->ssid_len),
5487 MAC_ARG(network->bssid),
James Ketrenosafbf30a2005-08-25 00:05:33 -05005488 priv->
5489 capability & CAP_PRIVACY_ON ? "on" : "off",
5490 network->
5491 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5492 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005493 return 0;
5494 }
5495
5496 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5497 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5498 "because of the same BSSID match: " MAC_FMT
5499 ".\n", escape_essid(network->ssid,
5500 network->ssid_len),
5501 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
5502 return 0;
5503 }
5504
5505 /* Filter out any incompatible freq / mode combinations */
5506 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5507 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5508 "because of invalid frequency/mode "
5509 "combination.\n",
5510 escape_essid(network->ssid, network->ssid_len),
5511 MAC_ARG(network->bssid));
5512 return 0;
5513 }
5514
5515 /* Ensure that the rates supported by the driver are compatible with
5516 * this AP, including verification of basic rates (mandatory) */
5517 if (!ipw_compatible_rates(priv, network, &rates)) {
5518 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5519 "because configured rate mask excludes "
5520 "AP mandatory rate.\n",
5521 escape_essid(network->ssid, network->ssid_len),
5522 MAC_ARG(network->bssid));
5523 return 0;
5524 }
5525
5526 if (rates.num_rates == 0) {
5527 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5528 "because of no compatible rates.\n",
5529 escape_essid(network->ssid, network->ssid_len),
5530 MAC_ARG(network->bssid));
5531 return 0;
5532 }
5533
5534 /* TODO: Perform any further minimal comparititive tests. We do not
5535 * want to put too much policy logic here; intelligent scan selection
5536 * should occur within a generic IEEE 802.11 user space tool. */
5537
5538 /* Set up 'new' AP to this network */
5539 ipw_copy_rates(&match->rates, &rates);
5540 match->network = network;
5541 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' is a viable match.\n",
5542 escape_essid(network->ssid, network->ssid_len),
5543 MAC_ARG(network->bssid));
5544
5545 return 1;
5546}
5547
David Howellsc4028952006-11-22 14:57:56 +00005548static void ipw_merge_adhoc_network(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005549{
David Howellsc4028952006-11-22 14:57:56 +00005550 struct ipw_priv *priv =
5551 container_of(work, struct ipw_priv, merge_networks);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005552 struct ieee80211_network *network = NULL;
5553 struct ipw_network_match match = {
5554 .network = priv->assoc_network
5555 };
5556
James Ketrenosafbf30a2005-08-25 00:05:33 -05005557 if ((priv->status & STATUS_ASSOCIATED) &&
5558 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005559 /* First pass through ROAM process -- look for a better
5560 * network */
5561 unsigned long flags;
5562
5563 spin_lock_irqsave(&priv->ieee->lock, flags);
5564 list_for_each_entry(network, &priv->ieee->network_list, list) {
5565 if (network != priv->assoc_network)
5566 ipw_find_adhoc_network(priv, &match, network,
5567 1);
5568 }
5569 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5570
5571 if (match.network == priv->assoc_network) {
5572 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5573 "merge to.\n");
5574 return;
5575 }
5576
Zhu Yi46441512006-01-24 16:37:59 +08005577 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005578 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5579 IPW_DEBUG_MERGE("remove network %s\n",
5580 escape_essid(priv->essid,
5581 priv->essid_len));
5582 ipw_remove_current_network(priv);
5583 }
5584
5585 ipw_disassociate(priv);
5586 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005587 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005588 return;
5589 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005590}
5591
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005592static int ipw_best_network(struct ipw_priv *priv,
5593 struct ipw_network_match *match,
5594 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005595{
5596 struct ipw_supported_rates rates;
5597
5598 /* Verify that this network's capability is compatible with the
5599 * current mode (AdHoc or Infrastructure) */
5600 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005601 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005602 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5603 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5604 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005605 "capability mismatch.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005606 escape_essid(network->ssid, network->ssid_len),
5607 MAC_ARG(network->bssid));
5608 return 0;
5609 }
5610
5611 /* If we do not have an ESSID for this AP, we can not associate with
5612 * it */
5613 if (network->flags & NETWORK_EMPTY_ESSID) {
5614 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5615 "because of hidden ESSID.\n",
5616 escape_essid(network->ssid, network->ssid_len),
5617 MAC_ARG(network->bssid));
5618 return 0;
5619 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005620
James Ketrenos43f66a62005-03-25 12:31:53 -06005621 if (unlikely(roaming)) {
5622 /* If we are roaming, then ensure check if this is a valid
5623 * network to try and roam to */
5624 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005625 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005626 network->ssid_len)) {
5627 IPW_DEBUG_ASSOC("Netowrk '%s (" MAC_FMT ")' excluded "
5628 "because of non-network ESSID.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04005629 escape_essid(network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005630 network->ssid_len),
5631 MAC_ARG(network->bssid));
5632 return 0;
5633 }
5634 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005635 /* If an ESSID has been configured then compare the broadcast
5636 * ESSID to ours */
5637 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005638 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005639 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005640 min(network->ssid_len, priv->essid_len)))) {
5641 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005642 strncpy(escaped,
5643 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005644 sizeof(escaped));
5645 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005646 "because of ESSID mismatch: '%s'.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005647 escaped, MAC_ARG(network->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005648 escape_essid(priv->essid,
5649 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005650 return 0;
5651 }
5652 }
5653
5654 /* If the old network rate is better than this one, don't bother
5655 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005656 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005657 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005658 strncpy(escaped,
5659 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005660 sizeof(escaped));
5661 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded because "
5662 "'%s (" MAC_FMT ")' has a stronger signal.\n",
5663 escaped, MAC_ARG(network->bssid),
5664 escape_essid(match->network->ssid,
5665 match->network->ssid_len),
5666 MAC_ARG(match->network->bssid));
5667 return 0;
5668 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005669
James Ketrenos43f66a62005-03-25 12:31:53 -06005670 /* If this network has already had an association attempt within the
5671 * last 3 seconds, do not try and associate again... */
5672 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005673 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005674 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005675 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005676 "assoc attempt).\n",
5677 escape_essid(network->ssid, network->ssid_len),
5678 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005679 jiffies_to_msecs(jiffies -
5680 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005681 return 0;
5682 }
5683
5684 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005685 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005686 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005687 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005688 "because of age: %ums.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005689 escape_essid(network->ssid, network->ssid_len),
5690 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005691 jiffies_to_msecs(jiffies -
5692 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005693 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005694 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005695
Jeff Garzikbf794512005-07-31 13:07:26 -04005696 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005697 (network->channel != priv->channel)) {
5698 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5699 "because of channel mismatch: %d != %d.\n",
5700 escape_essid(network->ssid, network->ssid_len),
5701 MAC_ARG(network->bssid),
5702 network->channel, priv->channel);
5703 return 0;
5704 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005705
James Ketrenos43f66a62005-03-25 12:31:53 -06005706 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005707 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005708 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5709 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5710 "because of privacy mismatch: %s != %s.\n",
5711 escape_essid(network->ssid, network->ssid_len),
5712 MAC_ARG(network->bssid),
Jeff Garzikbf794512005-07-31 13:07:26 -04005713 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005714 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005715 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005716 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005717 return 0;
5718 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005719
5720 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005721 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5722 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5723 "because of BSSID mismatch: " MAC_FMT ".\n",
5724 escape_essid(network->ssid, network->ssid_len),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005725 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005726 return 0;
5727 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005728
James Ketrenos43f66a62005-03-25 12:31:53 -06005729 /* Filter out any incompatible freq / mode combinations */
5730 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5731 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5732 "because of invalid frequency/mode "
5733 "combination.\n",
5734 escape_essid(network->ssid, network->ssid_len),
5735 MAC_ARG(network->bssid));
5736 return 0;
5737 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005738
Liu Hong1fe0adb2005-08-19 09:33:10 -05005739 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005740 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05005741 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5742 "because of invalid channel in current GEO\n",
5743 escape_essid(network->ssid, network->ssid_len),
5744 MAC_ARG(network->bssid));
5745 return 0;
5746 }
5747
James Ketrenosea2b26e2005-08-24 21:25:16 -05005748 /* Ensure that the rates supported by the driver are compatible with
5749 * this AP, including verification of basic rates (mandatory) */
5750 if (!ipw_compatible_rates(priv, network, &rates)) {
5751 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5752 "because configured rate mask excludes "
5753 "AP mandatory rate.\n",
5754 escape_essid(network->ssid, network->ssid_len),
5755 MAC_ARG(network->bssid));
5756 return 0;
5757 }
5758
James Ketrenos43f66a62005-03-25 12:31:53 -06005759 if (rates.num_rates == 0) {
5760 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5761 "because of no compatible rates.\n",
5762 escape_essid(network->ssid, network->ssid_len),
5763 MAC_ARG(network->bssid));
5764 return 0;
5765 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005766
James Ketrenos43f66a62005-03-25 12:31:53 -06005767 /* TODO: Perform any further minimal comparititive tests. We do not
5768 * want to put too much policy logic here; intelligent scan selection
5769 * should occur within a generic IEEE 802.11 user space tool. */
5770
5771 /* Set up 'new' AP to this network */
5772 ipw_copy_rates(&match->rates, &rates);
5773 match->network = network;
5774
5775 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' is a viable match.\n",
5776 escape_essid(network->ssid, network->ssid_len),
5777 MAC_ARG(network->bssid));
5778
5779 return 1;
5780}
5781
Jeff Garzikbf794512005-07-31 13:07:26 -04005782static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005783 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005784{
Larry Finger1867b112006-02-28 09:48:28 -06005785 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005786 int i;
5787
James Ketrenos43f66a62005-03-25 12:31:53 -06005788 /*
5789 * For the purposes of scanning, we can set our wireless mode
5790 * to trigger scans across combinations of bands, but when it
5791 * comes to creating a new ad-hoc network, we have tell the FW
5792 * exactly which band to use.
5793 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005794 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005795 * chossen band. Attempting to create a new ad-hoc network
5796 * with an invalid channel for wireless mode will trigger a
5797 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005798 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005799 */
Larry Finger1867b112006-02-28 09:48:28 -06005800 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005801 case IEEE80211_52GHZ_BAND:
5802 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005803 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005804 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005805 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5806 IPW_WARNING("Overriding invalid channel\n");
5807 priv->channel = geo->a[0].channel;
5808 }
5809 break;
5810
5811 case IEEE80211_24GHZ_BAND:
5812 if (priv->ieee->mode & IEEE_G)
5813 network->mode = IEEE_G;
5814 else
5815 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005816 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005817 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005818 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5819 IPW_WARNING("Overriding invalid channel\n");
5820 priv->channel = geo->bg[0].channel;
5821 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005822 break;
5823
5824 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005825 IPW_WARNING("Overriding invalid channel\n");
5826 if (priv->ieee->mode & IEEE_A) {
5827 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005828 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005829 } else if (priv->ieee->mode & IEEE_G) {
5830 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005831 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005832 } else {
5833 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005834 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005835 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005836 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005837 }
5838
5839 network->channel = priv->channel;
5840 priv->config |= CFG_ADHOC_PERSIST;
5841 ipw_create_bssid(priv, network->bssid);
5842 network->ssid_len = priv->essid_len;
5843 memcpy(network->ssid, priv->essid, priv->essid_len);
5844 memset(&network->stats, 0, sizeof(network->stats));
5845 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005846 if (!(priv->config & CFG_PREAMBLE_LONG))
5847 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005848 if (priv->capability & CAP_PRIVACY_ON)
5849 network->capability |= WLAN_CAPABILITY_PRIVACY;
5850 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005851 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005852 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005853 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005854 &priv->rates.supported_rates[network->rates_len],
5855 network->rates_ex_len);
5856 network->last_scanned = 0;
5857 network->flags = 0;
5858 network->last_associate = 0;
5859 network->time_stamp[0] = 0;
5860 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005861 network->beacon_interval = 100; /* Default */
5862 network->listen_interval = 10; /* Default */
5863 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005864 network->wpa_ie_len = 0;
5865 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005866}
5867
James Ketrenosb095c382005-08-24 22:04:42 -05005868static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5869{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005870 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005871
5872 if (!(priv->ieee->sec.flags & (1 << index)))
5873 return;
5874
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005875 key.key_id = index;
5876 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5877 key.security_type = type;
5878 key.station_index = 0; /* always 0 for BSS */
5879 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005880 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005881 key.tx_counter[0] = cpu_to_le32(0);
5882 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005883
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005884 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005885}
5886
5887static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005888{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005889 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005890 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005891
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005892 key.cmd_id = DINO_CMD_WEP_KEY;
5893 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005894
James Ketrenosb095c382005-08-24 22:04:42 -05005895 /* Note: AES keys cannot be set for multiple times.
5896 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005897 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005898 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005899 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005900 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005901 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005902 }
5903
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005904 key.key_size = priv->ieee->sec.key_sizes[i];
5905 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005906
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005907 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005908 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005909}
5910
Zhu Yi1fbfea52005-08-05 17:22:56 +08005911static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5912{
5913 if (priv->ieee->host_encrypt)
5914 return;
5915
5916 switch (level) {
5917 case SEC_LEVEL_3:
5918 priv->sys_config.disable_unicast_decryption = 0;
5919 priv->ieee->host_decrypt = 0;
5920 break;
5921 case SEC_LEVEL_2:
5922 priv->sys_config.disable_unicast_decryption = 1;
5923 priv->ieee->host_decrypt = 1;
5924 break;
5925 case SEC_LEVEL_1:
5926 priv->sys_config.disable_unicast_decryption = 0;
5927 priv->ieee->host_decrypt = 0;
5928 break;
5929 case SEC_LEVEL_0:
5930 priv->sys_config.disable_unicast_decryption = 1;
5931 break;
5932 default:
5933 break;
5934 }
5935}
5936
5937static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5938{
5939 if (priv->ieee->host_encrypt)
5940 return;
5941
5942 switch (level) {
5943 case SEC_LEVEL_3:
5944 priv->sys_config.disable_multicast_decryption = 0;
5945 break;
5946 case SEC_LEVEL_2:
5947 priv->sys_config.disable_multicast_decryption = 1;
5948 break;
5949 case SEC_LEVEL_1:
5950 priv->sys_config.disable_multicast_decryption = 0;
5951 break;
5952 case SEC_LEVEL_0:
5953 priv->sys_config.disable_multicast_decryption = 1;
5954 break;
5955 default:
5956 break;
5957 }
5958}
5959
James Ketrenosb095c382005-08-24 22:04:42 -05005960static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
5961{
5962 switch (priv->ieee->sec.level) {
5963 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005964 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5965 ipw_send_tgi_tx_key(priv,
5966 DCT_FLAG_EXT_SECURITY_CCM,
5967 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005968
Hong Liu567deaf2005-08-31 18:07:22 +08005969 if (!priv->ieee->host_mc_decrypt)
5970 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05005971 break;
5972 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005973 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5974 ipw_send_tgi_tx_key(priv,
5975 DCT_FLAG_EXT_SECURITY_TKIP,
5976 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05005977 break;
5978 case SEC_LEVEL_1:
5979 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05005980 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
5981 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05005982 break;
5983 case SEC_LEVEL_0:
5984 default:
5985 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005986 }
5987}
5988
5989static void ipw_adhoc_check(void *data)
5990{
5991 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04005992
James Ketrenosafbf30a2005-08-25 00:05:33 -05005993 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005994 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005995 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
5996 IPW_DL_STATE | IPW_DL_ASSOC,
5997 "Missed beacon: %d - disassociate\n",
5998 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06005999 ipw_remove_current_network(priv);
6000 ipw_disassociate(priv);
6001 return;
6002 }
6003
Jeff Garzikbf794512005-07-31 13:07:26 -04006004 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
James Ketrenos43f66a62005-03-25 12:31:53 -06006005 priv->assoc_request.beacon_interval);
6006}
6007
David Howellsc4028952006-11-22 14:57:56 +00006008static void ipw_bg_adhoc_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006009{
David Howellsc4028952006-11-22 14:57:56 +00006010 struct ipw_priv *priv =
6011 container_of(work, struct ipw_priv, adhoc_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08006012 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006013 ipw_adhoc_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006014 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006015}
6016
James Ketrenos43f66a62005-03-25 12:31:53 -06006017static void ipw_debug_config(struct ipw_priv *priv)
6018{
6019 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
6020 "[CFG 0x%08X]\n", priv->config);
6021 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006022 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06006023 else
6024 IPW_DEBUG_INFO("Channel unlocked.\n");
6025 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04006026 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006027 escape_essid(priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06006028 else
6029 IPW_DEBUG_INFO("ESSID unlocked.\n");
6030 if (priv->config & CFG_STATIC_BSSID)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006031 IPW_DEBUG_INFO("BSSID locked to " MAC_FMT "\n",
6032 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06006033 else
6034 IPW_DEBUG_INFO("BSSID unlocked.\n");
6035 if (priv->capability & CAP_PRIVACY_ON)
6036 IPW_DEBUG_INFO("PRIVACY on\n");
6037 else
6038 IPW_DEBUG_INFO("PRIVACY off\n");
6039 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
6040}
James Ketrenos43f66a62005-03-25 12:31:53 -06006041
Arjan van de Ven858119e2006-01-14 13:20:43 -08006042static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06006043{
6044 /* TODO: Verify that this works... */
6045 struct ipw_fixed_rate fr = {
6046 .tx_rates = priv->rates_mask
6047 };
6048 u32 reg;
6049 u16 mask = 0;
6050
Jeff Garzikbf794512005-07-31 13:07:26 -04006051 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06006052 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04006053
James Ketrenos43f66a62005-03-25 12:31:53 -06006054 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006055 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06006056 /* IEEE_A */
6057 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6058 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006059 IPW_DEBUG_WX
6060 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006061 fr.tx_rates = 0;
6062 break;
6063 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006064
James Ketrenos43f66a62005-03-25 12:31:53 -06006065 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6066 break;
6067
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006068 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006069 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006070 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006071 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6072 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006073 IPW_DEBUG_WX
6074 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006075 fr.tx_rates = 0;
6076 }
6077 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006078 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006079
6080 /* IEEE_G */
6081 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6082 IEEE80211_OFDM_RATES_MASK)) {
6083 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006084 IPW_DEBUG_WX
6085 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006086 fr.tx_rates = 0;
6087 break;
6088 }
6089
6090 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6091 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6092 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6093 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006094
James Ketrenos43f66a62005-03-25 12:31:53 -06006095 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6096 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6097 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6098 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006099
James Ketrenos43f66a62005-03-25 12:31:53 -06006100 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6101 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6102 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6103 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006104
James Ketrenos43f66a62005-03-25 12:31:53 -06006105 fr.tx_rates |= mask;
6106 break;
6107 }
6108
6109 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006110 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006111}
6112
James Ketrenosea2b26e2005-08-24 21:25:16 -05006113static void ipw_abort_scan(struct ipw_priv *priv)
6114{
6115 int err;
6116
6117 if (priv->status & STATUS_SCAN_ABORTING) {
6118 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6119 return;
6120 }
6121 priv->status |= STATUS_SCAN_ABORTING;
6122
6123 err = ipw_send_scan_abort(priv);
6124 if (err)
6125 IPW_DEBUG_HC("Request to abort scan failed.\n");
6126}
6127
James Ketrenosafbf30a2005-08-25 00:05:33 -05006128static void ipw_add_scan_channels(struct ipw_priv *priv,
6129 struct ipw_scan_request_ext *scan,
6130 int scan_type)
6131{
6132 int channel_index = 0;
6133 const struct ieee80211_geo *geo;
6134 int i;
6135
Larry Finger1867b112006-02-28 09:48:28 -06006136 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006137
6138 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6139 int start = channel_index;
6140 for (i = 0; i < geo->a_channels; i++) {
6141 if ((priv->status & STATUS_ASSOCIATED) &&
6142 geo->a[i].channel == priv->channel)
6143 continue;
6144 channel_index++;
6145 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006146 ipw_set_scan_type(scan, channel_index,
6147 geo->a[i].
6148 flags & IEEE80211_CH_PASSIVE_ONLY ?
6149 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6150 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006151 }
6152
6153 if (start != channel_index) {
6154 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6155 (channel_index - start);
6156 channel_index++;
6157 }
6158 }
6159
6160 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6161 int start = channel_index;
6162 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006163 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006164 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6165 /* nop out the list */
6166 [0] = 0
6167 };
6168
6169 u8 channel;
6170 while (channel_index < IPW_SCAN_CHANNELS) {
6171 channel =
6172 priv->speed_scan[priv->speed_scan_pos];
6173 if (channel == 0) {
6174 priv->speed_scan_pos = 0;
6175 channel = priv->speed_scan[0];
6176 }
6177 if ((priv->status & STATUS_ASSOCIATED) &&
6178 channel == priv->channel) {
6179 priv->speed_scan_pos++;
6180 continue;
6181 }
6182
6183 /* If this channel has already been
6184 * added in scan, break from loop
6185 * and this will be the first channel
6186 * in the next scan.
6187 */
6188 if (channels[channel - 1] != 0)
6189 break;
6190
6191 channels[channel - 1] = 1;
6192 priv->speed_scan_pos++;
6193 channel_index++;
6194 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006195 index =
Larry Finger1867b112006-02-28 09:48:28 -06006196 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006197 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006198 geo->bg[index].
6199 flags &
6200 IEEE80211_CH_PASSIVE_ONLY ?
6201 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6202 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006203 }
6204 } else {
6205 for (i = 0; i < geo->bg_channels; i++) {
6206 if ((priv->status & STATUS_ASSOCIATED) &&
6207 geo->bg[i].channel == priv->channel)
6208 continue;
6209 channel_index++;
6210 scan->channels_list[channel_index] =
6211 geo->bg[i].channel;
6212 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006213 geo->bg[i].
6214 flags &
6215 IEEE80211_CH_PASSIVE_ONLY ?
6216 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6217 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006218 }
6219 }
6220
6221 if (start != channel_index) {
6222 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6223 (channel_index - start);
6224 }
6225 }
6226}
6227
Zhu Yi094c4d22006-08-21 11:39:03 +08006228static int ipw_request_scan_helper(struct ipw_priv *priv, int type)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006229{
6230 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006231 int err = 0, scan_type;
6232
6233 if (!(priv->status & STATUS_INIT) ||
6234 (priv->status & STATUS_EXIT_PENDING))
6235 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006236
Zhu Yi46441512006-01-24 16:37:59 +08006237 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006238
James Ketrenosea2b26e2005-08-24 21:25:16 -05006239 if (priv->status & STATUS_SCANNING) {
James Ketrenosa613bff2005-08-24 21:43:11 -05006240 IPW_DEBUG_HC("Concurrent scan requested. Ignoring.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05006241 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006242 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006243 }
6244
James Ketrenosafbf30a2005-08-25 00:05:33 -05006245 if (!(priv->status & STATUS_SCAN_FORCED) &&
6246 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006247 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
6248 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006249 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006250 }
6251
6252 if (priv->status & STATUS_RF_KILL_MASK) {
6253 IPW_DEBUG_HC("Aborting scan due to RF Kill activation\n");
6254 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006255 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006256 }
6257
6258 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006259 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006260
Zhu Yi094c4d22006-08-21 11:39:03 +08006261 if (type == IW_SCAN_TYPE_PASSIVE) {
6262 IPW_DEBUG_WX("use passive scanning\n");
6263 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
6264 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6265 cpu_to_le16(120);
6266 ipw_add_scan_channels(priv, &scan, scan_type);
6267 goto send_request;
6268 }
6269
6270 /* Use active scan by default. */
6271 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006272 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006273 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006274 else
6275 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006276 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006277
James Ketrenosa613bff2005-08-24 21:43:11 -05006278 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006279 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006280
Zhu Yi094c4d22006-08-21 11:39:03 +08006281 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006282
James Ketrenosb095c382005-08-24 22:04:42 -05006283#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006284 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006285 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006286 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006287
Larry Finger1867b112006-02-28 09:48:28 -06006288 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006289 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006290 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006291 channel = priv->channel;
6292 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006293
James Ketrenosb095c382005-08-24 22:04:42 -05006294 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006295 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006296 channel = priv->channel;
6297 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006298
James Ketrenosb095c382005-08-24 22:04:42 -05006299 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006300 band = (u8) (IPW_B_MODE << 6) | 1;
6301 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006302 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006303 }
6304
James Ketrenosb095c382005-08-24 22:04:42 -05006305 scan.channels_list[0] = band;
6306 scan.channels_list[1] = channel;
6307 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006308
James Ketrenosb095c382005-08-24 22:04:42 -05006309 /* NOTE: The card will sit on this channel for this time
6310 * period. Scan aborts are timing sensitive and frequently
6311 * result in firmware restarts. As such, it is best to
6312 * set a small dwell_time here and just keep re-issuing
6313 * scans. Otherwise fast channel hopping will not actually
6314 * hop channels.
6315 *
6316 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006317 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006318 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006319 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006320#endif /* CONFIG_IPW2200_MONITOR */
6321 /* If we are roaming, then make this a directed scan for the
6322 * current network. Otherwise, ensure that every other scan
6323 * is a fast channel hop scan */
6324 if ((priv->status & STATUS_ROAMING)
6325 || (!(priv->status & STATUS_ASSOCIATED)
6326 && (priv->config & CFG_STATIC_ESSID)
6327 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006328 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6329 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006330 IPW_DEBUG_HC("Attempt to send SSID command "
6331 "failed.\n");
6332 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006333 }
6334
6335 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006336 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006337 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006338
James Ketrenosafbf30a2005-08-25 00:05:33 -05006339 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006340#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006341 }
6342#endif
6343
Zhu Yi094c4d22006-08-21 11:39:03 +08006344send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006345 err = ipw_send_scan_request_ext(priv, &scan);
6346 if (err) {
6347 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006348 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006349 }
6350
6351 priv->status |= STATUS_SCANNING;
6352 priv->status &= ~STATUS_SCAN_PENDING;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006353 queue_delayed_work(priv->workqueue, &priv->scan_check,
6354 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006355done:
Zhu Yi46441512006-01-24 16:37:59 +08006356 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006357 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006358}
6359
David Howellsc4028952006-11-22 14:57:56 +00006360static void ipw_request_passive_scan(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006361{
David Howellsc4028952006-11-22 14:57:56 +00006362 struct ipw_priv *priv =
6363 container_of(work, struct ipw_priv, request_passive_scan);
6364 ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE);
6365}
6366
6367static void ipw_request_scan(struct work_struct *work)
6368{
6369 struct ipw_priv *priv =
6370 container_of(work, struct ipw_priv, request_scan.work);
6371 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE);
6372}
6373
6374static void ipw_bg_abort_scan(struct work_struct *work)
6375{
6376 struct ipw_priv *priv =
6377 container_of(work, struct ipw_priv, abort_scan);
Zhu Yi46441512006-01-24 16:37:59 +08006378 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006379 ipw_abort_scan(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006380 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006381}
6382
James Ketrenosea2b26e2005-08-24 21:25:16 -05006383static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6384{
James Ketrenosb095c382005-08-24 22:04:42 -05006385 /* This is called when wpa_supplicant loads and closes the driver
6386 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006387 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006388 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006389}
6390
James Ketrenosea2b26e2005-08-24 21:25:16 -05006391static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6392{
6393 struct ieee80211_device *ieee = priv->ieee;
6394 struct ieee80211_security sec = {
6395 .flags = SEC_AUTH_MODE,
6396 };
6397 int ret = 0;
6398
James Ketrenosafbf30a2005-08-25 00:05:33 -05006399 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006400 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6401 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006402 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006403 sec.auth_mode = WLAN_AUTH_OPEN;
6404 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006405 } else if (value & IW_AUTH_ALG_LEAP) {
6406 sec.auth_mode = WLAN_AUTH_LEAP;
6407 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006408 } else
6409 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006410
6411 if (ieee->set_security)
6412 ieee->set_security(ieee->dev, &sec);
6413 else
6414 ret = -EOPNOTSUPP;
6415
6416 return ret;
6417}
6418
Adrian Bunka73e22b2006-01-21 01:39:42 +01006419static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6420 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006421{
6422 /* make sure WPA is enabled */
6423 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006424}
6425
6426static int ipw_set_rsn_capa(struct ipw_priv *priv,
6427 char *capabilities, int length)
6428{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006429 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6430
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006431 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006432 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006433}
6434
James Ketrenosafbf30a2005-08-25 00:05:33 -05006435/*
6436 * WE-18 support
6437 */
6438
6439/* SIOCSIWGENIE */
6440static int ipw_wx_set_genie(struct net_device *dev,
6441 struct iw_request_info *info,
6442 union iwreq_data *wrqu, char *extra)
6443{
6444 struct ipw_priv *priv = ieee80211_priv(dev);
6445 struct ieee80211_device *ieee = priv->ieee;
6446 u8 *buf;
6447 int err = 0;
6448
6449 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6450 (wrqu->data.length && extra == NULL))
6451 return -EINVAL;
6452
James Ketrenosafbf30a2005-08-25 00:05:33 -05006453 if (wrqu->data.length) {
6454 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6455 if (buf == NULL) {
6456 err = -ENOMEM;
6457 goto out;
6458 }
6459
6460 memcpy(buf, extra, wrqu->data.length);
6461 kfree(ieee->wpa_ie);
6462 ieee->wpa_ie = buf;
6463 ieee->wpa_ie_len = wrqu->data.length;
6464 } else {
6465 kfree(ieee->wpa_ie);
6466 ieee->wpa_ie = NULL;
6467 ieee->wpa_ie_len = 0;
6468 }
6469
6470 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6471 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006472 return err;
6473}
6474
6475/* SIOCGIWGENIE */
6476static int ipw_wx_get_genie(struct net_device *dev,
6477 struct iw_request_info *info,
6478 union iwreq_data *wrqu, char *extra)
6479{
6480 struct ipw_priv *priv = ieee80211_priv(dev);
6481 struct ieee80211_device *ieee = priv->ieee;
6482 int err = 0;
6483
James Ketrenosafbf30a2005-08-25 00:05:33 -05006484 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6485 wrqu->data.length = 0;
6486 goto out;
6487 }
6488
6489 if (wrqu->data.length < ieee->wpa_ie_len) {
6490 err = -E2BIG;
6491 goto out;
6492 }
6493
6494 wrqu->data.length = ieee->wpa_ie_len;
6495 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6496
6497 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006498 return err;
6499}
6500
Zhu Yi1fbfea52005-08-05 17:22:56 +08006501static int wext_cipher2level(int cipher)
6502{
6503 switch (cipher) {
6504 case IW_AUTH_CIPHER_NONE:
6505 return SEC_LEVEL_0;
6506 case IW_AUTH_CIPHER_WEP40:
6507 case IW_AUTH_CIPHER_WEP104:
6508 return SEC_LEVEL_1;
6509 case IW_AUTH_CIPHER_TKIP:
6510 return SEC_LEVEL_2;
6511 case IW_AUTH_CIPHER_CCMP:
6512 return SEC_LEVEL_3;
6513 default:
6514 return -1;
6515 }
6516}
6517
James Ketrenosafbf30a2005-08-25 00:05:33 -05006518/* SIOCSIWAUTH */
6519static int ipw_wx_set_auth(struct net_device *dev,
6520 struct iw_request_info *info,
6521 union iwreq_data *wrqu, char *extra)
6522{
6523 struct ipw_priv *priv = ieee80211_priv(dev);
6524 struct ieee80211_device *ieee = priv->ieee;
6525 struct iw_param *param = &wrqu->param;
6526 struct ieee80211_crypt_data *crypt;
6527 unsigned long flags;
6528 int ret = 0;
6529
6530 switch (param->flags & IW_AUTH_INDEX) {
6531 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006532 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006533 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006534 ipw_set_hw_decrypt_unicast(priv,
6535 wext_cipher2level(param->value));
6536 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006537 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006538 ipw_set_hw_decrypt_multicast(priv,
6539 wext_cipher2level(param->value));
6540 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006541 case IW_AUTH_KEY_MGMT:
6542 /*
6543 * ipw2200 does not use these parameters
6544 */
6545 break;
6546
6547 case IW_AUTH_TKIP_COUNTERMEASURES:
6548 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006549 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006550 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006551
6552 flags = crypt->ops->get_flags(crypt->priv);
6553
6554 if (param->value)
6555 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6556 else
6557 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6558
6559 crypt->ops->set_flags(flags, crypt->priv);
6560
6561 break;
6562
6563 case IW_AUTH_DROP_UNENCRYPTED:{
6564 /* HACK:
6565 *
6566 * wpa_supplicant calls set_wpa_enabled when the driver
6567 * is loaded and unloaded, regardless of if WPA is being
6568 * used. No other calls are made which can be used to
6569 * determine if encryption will be used or not prior to
6570 * association being expected. If encryption is not being
6571 * used, drop_unencrypted is set to false, else true -- we
6572 * can use this to determine if the CAP_PRIVACY_ON bit should
6573 * be set.
6574 */
6575 struct ieee80211_security sec = {
6576 .flags = SEC_ENABLED,
6577 .enabled = param->value,
6578 };
6579 priv->ieee->drop_unencrypted = param->value;
6580 /* We only change SEC_LEVEL for open mode. Others
6581 * are set by ipw_wpa_set_encryption.
6582 */
6583 if (!param->value) {
6584 sec.flags |= SEC_LEVEL;
6585 sec.level = SEC_LEVEL_0;
6586 } else {
6587 sec.flags |= SEC_LEVEL;
6588 sec.level = SEC_LEVEL_1;
6589 }
6590 if (priv->ieee->set_security)
6591 priv->ieee->set_security(priv->ieee->dev, &sec);
6592 break;
6593 }
6594
6595 case IW_AUTH_80211_AUTH_ALG:
6596 ret = ipw_wpa_set_auth_algs(priv, param->value);
6597 break;
6598
6599 case IW_AUTH_WPA_ENABLED:
6600 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006601 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006602 break;
6603
6604 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6605 ieee->ieee802_1x = param->value;
6606 break;
6607
James Ketrenosafbf30a2005-08-25 00:05:33 -05006608 case IW_AUTH_PRIVACY_INVOKED:
6609 ieee->privacy_invoked = param->value;
6610 break;
6611
6612 default:
6613 return -EOPNOTSUPP;
6614 }
6615 return ret;
6616}
6617
6618/* SIOCGIWAUTH */
6619static int ipw_wx_get_auth(struct net_device *dev,
6620 struct iw_request_info *info,
6621 union iwreq_data *wrqu, char *extra)
6622{
6623 struct ipw_priv *priv = ieee80211_priv(dev);
6624 struct ieee80211_device *ieee = priv->ieee;
6625 struct ieee80211_crypt_data *crypt;
6626 struct iw_param *param = &wrqu->param;
6627 int ret = 0;
6628
6629 switch (param->flags & IW_AUTH_INDEX) {
6630 case IW_AUTH_WPA_VERSION:
6631 case IW_AUTH_CIPHER_PAIRWISE:
6632 case IW_AUTH_CIPHER_GROUP:
6633 case IW_AUTH_KEY_MGMT:
6634 /*
6635 * wpa_supplicant will control these internally
6636 */
6637 ret = -EOPNOTSUPP;
6638 break;
6639
6640 case IW_AUTH_TKIP_COUNTERMEASURES:
6641 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006642 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006643 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006644
6645 param->value = (crypt->ops->get_flags(crypt->priv) &
6646 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6647
6648 break;
6649
6650 case IW_AUTH_DROP_UNENCRYPTED:
6651 param->value = ieee->drop_unencrypted;
6652 break;
6653
6654 case IW_AUTH_80211_AUTH_ALG:
6655 param->value = ieee->sec.auth_mode;
6656 break;
6657
6658 case IW_AUTH_WPA_ENABLED:
6659 param->value = ieee->wpa_enabled;
6660 break;
6661
6662 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6663 param->value = ieee->ieee802_1x;
6664 break;
6665
6666 case IW_AUTH_ROAMING_CONTROL:
6667 case IW_AUTH_PRIVACY_INVOKED:
6668 param->value = ieee->privacy_invoked;
6669 break;
6670
6671 default:
6672 return -EOPNOTSUPP;
6673 }
6674 return 0;
6675}
6676
6677/* SIOCSIWENCODEEXT */
6678static int ipw_wx_set_encodeext(struct net_device *dev,
6679 struct iw_request_info *info,
6680 union iwreq_data *wrqu, char *extra)
6681{
6682 struct ipw_priv *priv = ieee80211_priv(dev);
6683 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6684
6685 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006686 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006687 /* IPW HW can't build TKIP MIC,
6688 host decryption still needed */
6689 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6690 priv->ieee->host_mc_decrypt = 1;
6691 else {
6692 priv->ieee->host_encrypt = 0;
6693 priv->ieee->host_encrypt_msdu = 1;
6694 priv->ieee->host_decrypt = 1;
6695 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006696 } else {
6697 priv->ieee->host_encrypt = 0;
6698 priv->ieee->host_encrypt_msdu = 0;
6699 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006700 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006701 }
6702 }
6703
6704 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6705}
6706
6707/* SIOCGIWENCODEEXT */
6708static int ipw_wx_get_encodeext(struct net_device *dev,
6709 struct iw_request_info *info,
6710 union iwreq_data *wrqu, char *extra)
6711{
6712 struct ipw_priv *priv = ieee80211_priv(dev);
6713 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6714}
6715
6716/* SIOCSIWMLME */
6717static int ipw_wx_set_mlme(struct net_device *dev,
6718 struct iw_request_info *info,
6719 union iwreq_data *wrqu, char *extra)
6720{
6721 struct ipw_priv *priv = ieee80211_priv(dev);
6722 struct iw_mlme *mlme = (struct iw_mlme *)extra;
6723 u16 reason;
6724
6725 reason = cpu_to_le16(mlme->reason_code);
6726
6727 switch (mlme->cmd) {
6728 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006729 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006730 break;
6731
6732 case IW_MLME_DISASSOC:
6733 ipw_disassociate(priv);
6734 break;
6735
6736 default:
6737 return -EOPNOTSUPP;
6738 }
6739 return 0;
6740}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006741
Zhu Yie43e3c12006-04-13 17:20:45 +08006742#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006743
6744/* QoS */
6745/*
6746* get the modulation type of the current network or
6747* the card current mode
6748*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006749static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006750{
6751 u8 mode = 0;
6752
6753 if (priv->status & STATUS_ASSOCIATED) {
6754 unsigned long flags;
6755
6756 spin_lock_irqsave(&priv->ieee->lock, flags);
6757 mode = priv->assoc_network->mode;
6758 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6759 } else {
6760 mode = priv->ieee->mode;
6761 }
6762 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6763 return mode;
6764}
6765
6766/*
6767* Handle management frame beacon and probe response
6768*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006769static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6770 int active_network,
6771 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006772{
6773 u32 size = sizeof(struct ieee80211_qos_parameters);
6774
James Ketrenosafbf30a2005-08-25 00:05:33 -05006775 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006776 network->qos_data.active = network->qos_data.supported;
6777
6778 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006779 if (active_network &&
6780 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006781 network->qos_data.active = network->qos_data.supported;
6782
6783 if ((network->qos_data.active == 1) && (active_network == 1) &&
6784 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6785 (network->qos_data.old_param_count !=
6786 network->qos_data.param_count)) {
6787 network->qos_data.old_param_count =
6788 network->qos_data.param_count;
6789 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006790 IPW_DEBUG_QOS("QoS parameters change call "
6791 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006792 }
6793 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006794 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6795 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006796 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006797 else
6798 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006799 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006800
James Ketrenosb095c382005-08-24 22:04:42 -05006801 if ((network->qos_data.active == 1) && (active_network == 1)) {
6802 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6803 schedule_work(&priv->qos_activate);
6804 }
6805
6806 network->qos_data.active = 0;
6807 network->qos_data.supported = 0;
6808 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006809 if ((priv->status & STATUS_ASSOCIATED) &&
6810 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6811 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
6812 if ((network->capability & WLAN_CAPABILITY_IBSS) &&
6813 !(network->flags & NETWORK_EMPTY_ESSID))
James Ketrenosb095c382005-08-24 22:04:42 -05006814 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006815 priv->assoc_network->ssid_len) &&
6816 !memcmp(network->ssid,
6817 priv->assoc_network->ssid,
6818 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006819 queue_work(priv->workqueue,
6820 &priv->merge_networks);
6821 }
James Ketrenosb095c382005-08-24 22:04:42 -05006822 }
6823
6824 return 0;
6825}
6826
6827/*
6828* This function set up the firmware to support QoS. It sends
6829* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6830*/
6831static int ipw_qos_activate(struct ipw_priv *priv,
6832 struct ieee80211_qos_data *qos_network_data)
6833{
6834 int err;
6835 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6836 struct ieee80211_qos_parameters *active_one = NULL;
6837 u32 size = sizeof(struct ieee80211_qos_parameters);
6838 u32 burst_duration;
6839 int i;
6840 u8 type;
6841
6842 type = ipw_qos_current_mode(priv);
6843
6844 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6845 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6846 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6847 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6848
6849 if (qos_network_data == NULL) {
6850 if (type == IEEE_B) {
6851 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6852 active_one = &def_parameters_CCK;
6853 } else
6854 active_one = &def_parameters_OFDM;
6855
James Ketrenosafbf30a2005-08-25 00:05:33 -05006856 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006857 burst_duration = ipw_qos_get_burst_duration(priv);
6858 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006859 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Zhu Yi851ca262006-08-21 11:37:58 +08006860 (u16)burst_duration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006861 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006862 if (type == IEEE_B) {
6863 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6864 type);
6865 if (priv->qos_data.qos_enable == 0)
6866 active_one = &def_parameters_CCK;
6867 else
6868 active_one = priv->qos_data.def_qos_parm_CCK;
6869 } else {
6870 if (priv->qos_data.qos_enable == 0)
6871 active_one = &def_parameters_OFDM;
6872 else
6873 active_one = priv->qos_data.def_qos_parm_OFDM;
6874 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006875 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006876 } else {
6877 unsigned long flags;
6878 int active;
6879
6880 spin_lock_irqsave(&priv->ieee->lock, flags);
6881 active_one = &(qos_network_data->parameters);
6882 qos_network_data->old_param_count =
6883 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006884 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006885 active = qos_network_data->supported;
6886 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6887
6888 if (active == 0) {
6889 burst_duration = ipw_qos_get_burst_duration(priv);
6890 for (i = 0; i < QOS_QUEUE_NUM; i++)
6891 qos_parameters[QOS_PARAM_SET_ACTIVE].
Zhu Yi851ca262006-08-21 11:37:58 +08006892 tx_op_limit[i] = (u16)burst_duration;
James Ketrenosb095c382005-08-24 22:04:42 -05006893 }
6894 }
6895
6896 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
Zhu Yi851ca262006-08-21 11:37:58 +08006897 for (i = 0; i < 3; i++) {
6898 int j;
6899 for (j = 0; j < QOS_QUEUE_NUM; j++) {
6900 qos_parameters[i].cw_min[j] = cpu_to_le16(qos_parameters[i].cw_min[j]);
6901 qos_parameters[i].cw_max[j] = cpu_to_le16(qos_parameters[i].cw_max[j]);
6902 qos_parameters[i].tx_op_limit[j] = cpu_to_le16(qos_parameters[i].tx_op_limit[j]);
6903 }
6904 }
6905
James Ketrenosafbf30a2005-08-25 00:05:33 -05006906 err = ipw_send_qos_params_command(priv,
6907 (struct ieee80211_qos_parameters *)
6908 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05006909 if (err)
6910 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
6911
6912 return err;
6913}
6914
6915/*
6916* send IPW_CMD_WME_INFO to the firmware
6917*/
6918static int ipw_qos_set_info_element(struct ipw_priv *priv)
6919{
6920 int ret = 0;
6921 struct ieee80211_qos_information_element qos_info;
6922
6923 if (priv == NULL)
6924 return -1;
6925
6926 qos_info.elementID = QOS_ELEMENT_ID;
6927 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
6928
6929 qos_info.version = QOS_VERSION_1;
6930 qos_info.ac_info = 0;
6931
6932 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
6933 qos_info.qui_type = QOS_OUI_TYPE;
6934 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
6935
6936 ret = ipw_send_qos_info_command(priv, &qos_info);
6937 if (ret != 0) {
6938 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
6939 }
6940 return ret;
6941}
6942
6943/*
6944* Set the QoS parameter with the association request structure
6945*/
6946static int ipw_qos_association(struct ipw_priv *priv,
6947 struct ieee80211_network *network)
6948{
6949 int err = 0;
6950 struct ieee80211_qos_data *qos_data = NULL;
6951 struct ieee80211_qos_data ibss_data = {
6952 .supported = 1,
6953 .active = 1,
6954 };
6955
6956 switch (priv->ieee->iw_mode) {
6957 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02006958 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05006959
6960 qos_data = &ibss_data;
6961 break;
6962
6963 case IW_MODE_INFRA:
6964 qos_data = &network->qos_data;
6965 break;
6966
6967 default:
6968 BUG();
6969 break;
6970 }
6971
6972 err = ipw_qos_activate(priv, qos_data);
6973 if (err) {
6974 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
6975 return err;
6976 }
6977
6978 if (priv->qos_data.qos_enable && qos_data->supported) {
6979 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
6980 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
6981 return ipw_qos_set_info_element(priv);
6982 }
6983
6984 return 0;
6985}
6986
6987/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01006988* handling the beaconing responses. if we get different QoS setting
6989* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05006990* setting
6991*/
6992static int ipw_qos_association_resp(struct ipw_priv *priv,
6993 struct ieee80211_network *network)
6994{
6995 int ret = 0;
6996 unsigned long flags;
6997 u32 size = sizeof(struct ieee80211_qos_parameters);
6998 int set_qos_param = 0;
6999
James Ketrenosafbf30a2005-08-25 00:05:33 -05007000 if ((priv == NULL) || (network == NULL) ||
7001 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05007002 return ret;
7003
7004 if (!(priv->status & STATUS_ASSOCIATED))
7005 return ret;
7006
James Ketrenosafbf30a2005-08-25 00:05:33 -05007007 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05007008 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05007009
7010 spin_lock_irqsave(&priv->ieee->lock, flags);
7011 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007012 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05007013 sizeof(struct ieee80211_qos_data));
7014 priv->assoc_network->qos_data.active = 1;
7015 if ((network->qos_data.old_param_count !=
7016 network->qos_data.param_count)) {
7017 set_qos_param = 1;
7018 network->qos_data.old_param_count =
7019 network->qos_data.param_count;
7020 }
7021
7022 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007023 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
7024 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007025 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007026 else
7027 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007028 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05007029 priv->assoc_network->qos_data.active = 0;
7030 priv->assoc_network->qos_data.supported = 0;
7031 set_qos_param = 1;
7032 }
7033
7034 spin_unlock_irqrestore(&priv->ieee->lock, flags);
7035
7036 if (set_qos_param == 1)
7037 schedule_work(&priv->qos_activate);
7038
7039 return ret;
7040}
7041
7042static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
7043{
7044 u32 ret = 0;
7045
7046 if ((priv == NULL))
7047 return 0;
7048
James Ketrenosafbf30a2005-08-25 00:05:33 -05007049 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05007050 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007051 else
James Ketrenosb095c382005-08-24 22:04:42 -05007052 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007053
James Ketrenosb095c382005-08-24 22:04:42 -05007054 return ret;
7055}
7056
7057/*
7058* Initialize the setting of QoS global
7059*/
7060static void ipw_qos_init(struct ipw_priv *priv, int enable,
7061 int burst_enable, u32 burst_duration_CCK,
7062 u32 burst_duration_OFDM)
7063{
7064 priv->qos_data.qos_enable = enable;
7065
7066 if (priv->qos_data.qos_enable) {
7067 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7068 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7069 IPW_DEBUG_QOS("QoS is enabled\n");
7070 } else {
7071 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7072 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7073 IPW_DEBUG_QOS("QoS is not enabled\n");
7074 }
7075
7076 priv->qos_data.burst_enable = burst_enable;
7077
7078 if (burst_enable) {
7079 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7080 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7081 } else {
7082 priv->qos_data.burst_duration_CCK = 0;
7083 priv->qos_data.burst_duration_OFDM = 0;
7084 }
7085}
7086
7087/*
7088* map the packet priority to the right TX Queue
7089*/
7090static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7091{
7092 if (priority > 7 || !priv->qos_data.qos_enable)
7093 priority = 0;
7094
7095 return from_priority_to_tx_queue[priority] - 1;
7096}
7097
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007098static int ipw_is_qos_active(struct net_device *dev,
7099 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007100{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007101 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007102 struct ieee80211_qos_data *qos_data = NULL;
7103 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007104 u8 *daddr = skb->data + ETH_ALEN;
7105 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007106
7107 if (!(priv->status & STATUS_ASSOCIATED))
7108 return 0;
7109
7110 qos_data = &priv->assoc_network->qos_data;
7111
James Ketrenosb095c382005-08-24 22:04:42 -05007112 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7113 if (unicast == 0)
7114 qos_data->active = 0;
7115 else
7116 qos_data->active = qos_data->supported;
7117 }
James Ketrenosb095c382005-08-24 22:04:42 -05007118 active = qos_data->active;
7119 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007120 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7121 "unicast %d\n",
7122 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007123 if (active && priv->qos_data.qos_enable)
7124 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007125
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007126 return 0;
7127
7128}
7129/*
7130* add QoS parameter to the TX command
7131*/
7132static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7133 u16 priority,
7134 struct tfd_data *tfd)
7135{
7136 int tx_queue_id = 0;
7137
7138
7139 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7140 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7141
7142 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7143 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007144 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007145 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007146 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007147}
7148
7149/*
7150* background support to run QoS activate functionality
7151*/
David Howellsc4028952006-11-22 14:57:56 +00007152static void ipw_bg_qos_activate(struct work_struct *work)
James Ketrenosb095c382005-08-24 22:04:42 -05007153{
David Howellsc4028952006-11-22 14:57:56 +00007154 struct ipw_priv *priv =
7155 container_of(work, struct ipw_priv, qos_activate);
James Ketrenosb095c382005-08-24 22:04:42 -05007156
7157 if (priv == NULL)
7158 return;
7159
Zhu Yi46441512006-01-24 16:37:59 +08007160 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007161
7162 if (priv->status & STATUS_ASSOCIATED)
7163 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7164
Zhu Yi46441512006-01-24 16:37:59 +08007165 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007166}
7167
James Ketrenos3b9990c2005-08-19 13:18:55 -05007168static int ipw_handle_probe_response(struct net_device *dev,
7169 struct ieee80211_probe_response *resp,
7170 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007171{
7172 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007173 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7174 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007175
James Ketrenos3b9990c2005-08-19 13:18:55 -05007176 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007177
James Ketrenos3b9990c2005-08-19 13:18:55 -05007178 return 0;
7179}
James Ketrenosb095c382005-08-24 22:04:42 -05007180
James Ketrenos3b9990c2005-08-19 13:18:55 -05007181static int ipw_handle_beacon(struct net_device *dev,
7182 struct ieee80211_beacon *resp,
7183 struct ieee80211_network *network)
7184{
7185 struct ipw_priv *priv = ieee80211_priv(dev);
7186 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7187 (network == priv->assoc_network));
7188
7189 ipw_qos_handle_probe_response(priv, active_network, network);
7190
7191 return 0;
7192}
7193
7194static int ipw_handle_assoc_response(struct net_device *dev,
7195 struct ieee80211_assoc_response *resp,
7196 struct ieee80211_network *network)
7197{
7198 struct ipw_priv *priv = ieee80211_priv(dev);
7199 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007200 return 0;
7201}
7202
7203static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7204 *qos_param)
7205{
Zhu Yi4e226992006-01-24 16:37:36 +08007206 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7207 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007208}
7209
7210static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7211 *qos_param)
7212{
Zhu Yi4e226992006-01-24 16:37:36 +08007213 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7214 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007215}
7216
Zhu Yie43e3c12006-04-13 17:20:45 +08007217#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007218
James Ketrenos43f66a62005-03-25 12:31:53 -06007219static int ipw_associate_network(struct ipw_priv *priv,
7220 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007221 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007222{
7223 int err;
7224
7225 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007226 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007227
7228 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007229 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007230 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007231 memcpy(priv->essid, network->ssid, priv->essid_len);
7232 }
7233
7234 network->last_associate = jiffies;
7235
7236 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7237 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007238 priv->assoc_request.auth_key = 0;
7239
James Ketrenos43f66a62005-03-25 12:31:53 -06007240 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007241 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007242 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007243 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7244
Zhu Yi1ba61e02006-02-15 13:00:55 +08007245 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007246 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007247
7248 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7249 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7250 priv->assoc_request.auth_type = AUTH_LEAP;
7251 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007252 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007253
James Ketrenosa613bff2005-08-24 21:43:11 -05007254 if (priv->ieee->wpa_ie_len) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05007255 priv->assoc_request.policy_support = 0x02; /* RSN active */
7256 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7257 priv->ieee->wpa_ie_len);
7258 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007259
Jeff Garzikbf794512005-07-31 13:07:26 -04007260 /*
7261 * It is valid for our ieee device to support multiple modes, but
7262 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007263 * just one mode.
7264 */
7265 if (network->mode & priv->ieee->mode & IEEE_A)
7266 priv->assoc_request.ieee_mode = IPW_A_MODE;
7267 else if (network->mode & priv->ieee->mode & IEEE_G)
7268 priv->assoc_request.ieee_mode = IPW_G_MODE;
7269 else if (network->mode & priv->ieee->mode & IEEE_B)
7270 priv->assoc_request.ieee_mode = IPW_B_MODE;
7271
James Ketrenosea2b26e2005-08-24 21:25:16 -05007272 priv->assoc_request.capability = network->capability;
7273 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7274 && !(priv->config & CFG_PREAMBLE_LONG)) {
7275 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7276 } else {
7277 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7278
7279 /* Clear the short preamble if we won't be supporting it */
7280 priv->assoc_request.capability &=
7281 ~WLAN_CAPABILITY_SHORT_PREAMBLE;
7282 }
7283
James Ketrenosafbf30a2005-08-25 00:05:33 -05007284 /* Clear capability bits that aren't used in Ad Hoc */
7285 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7286 priv->assoc_request.capability &=
7287 ~WLAN_CAPABILITY_SHORT_SLOT_TIME;
7288
James Ketrenos43f66a62005-03-25 12:31:53 -06007289 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007290 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007291 roaming ? "Rea" : "A",
Jeff Garzikbf794512005-07-31 13:07:26 -04007292 escape_essid(priv->essid, priv->essid_len),
7293 network->channel,
7294 ipw_modes[priv->assoc_request.ieee_mode],
7295 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007296 (priv->assoc_request.preamble_length ==
7297 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7298 network->capability &
7299 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007300 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007301 priv->capability & CAP_PRIVACY_ON ?
7302 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007303 "(open)") : "",
7304 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007305 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007306 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007307 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007308
7309 priv->assoc_request.beacon_interval = network->beacon_interval;
7310 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007311 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007312 priv->assoc_request.assoc_type = HC_IBSS_START;
7313 priv->assoc_request.assoc_tsf_msw = 0;
7314 priv->assoc_request.assoc_tsf_lsw = 0;
7315 } else {
7316 if (unlikely(roaming))
7317 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7318 else
7319 priv->assoc_request.assoc_type = HC_ASSOCIATE;
7320 priv->assoc_request.assoc_tsf_msw = network->time_stamp[1];
7321 priv->assoc_request.assoc_tsf_lsw = network->time_stamp[0];
7322 }
7323
James Ketrenosafbf30a2005-08-25 00:05:33 -05007324 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007325
7326 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7327 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
7328 priv->assoc_request.atim_window = network->atim_window;
7329 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007330 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007331 priv->assoc_request.atim_window = 0;
7332 }
7333
James Ketrenos43f66a62005-03-25 12:31:53 -06007334 priv->assoc_request.listen_interval = network->listen_interval;
Jeff Garzikbf794512005-07-31 13:07:26 -04007335
James Ketrenos43f66a62005-03-25 12:31:53 -06007336 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7337 if (err) {
7338 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7339 return err;
7340 }
7341
7342 rates->ieee_mode = priv->assoc_request.ieee_mode;
7343 rates->purpose = IPW_RATE_CONNECT;
7344 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007345
James Ketrenos43f66a62005-03-25 12:31:53 -06007346 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7347 priv->sys_config.dot11g_auto_detection = 1;
7348 else
7349 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007350
7351 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7352 priv->sys_config.answer_broadcast_ssid_probe = 1;
7353 else
7354 priv->sys_config.answer_broadcast_ssid_probe = 0;
7355
Zhu Yid685b8c2006-04-13 17:20:27 +08007356 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007357 if (err) {
7358 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7359 return err;
7360 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007361
James Ketrenos43f66a62005-03-25 12:31:53 -06007362 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007363 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007364 if (err) {
7365 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7366 return err;
7367 }
7368
7369 /*
7370 * If preemption is enabled, it is possible for the association
7371 * to complete before we return from ipw_send_associate. Therefore
7372 * we have to be sure and update our priviate data first.
7373 */
7374 priv->channel = network->channel;
7375 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007376 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007377 priv->status &= ~STATUS_SECURITY_UPDATED;
7378
7379 priv->assoc_network = network;
7380
Zhu Yie43e3c12006-04-13 17:20:45 +08007381#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007382 ipw_qos_association(priv, network);
7383#endif
7384
James Ketrenos43f66a62005-03-25 12:31:53 -06007385 err = ipw_send_associate(priv, &priv->assoc_request);
7386 if (err) {
7387 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7388 return err;
7389 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007390
7391 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' " MAC_FMT " \n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007392 escape_essid(priv->essid, priv->essid_len),
7393 MAC_ARG(priv->bssid));
7394
7395 return 0;
7396}
7397
7398static void ipw_roam(void *data)
7399{
7400 struct ipw_priv *priv = data;
7401 struct ieee80211_network *network = NULL;
7402 struct ipw_network_match match = {
7403 .network = priv->assoc_network
7404 };
7405
7406 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007407 *
7408 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007409 * setting the status ROAM bit and requesting a scan.
7410 * 2. When the scan completes, it schedules the ROAM work
7411 * 3. The ROAM work looks at all of the known networks for one that
7412 * is a better network than the currently associated. If none
7413 * found, the ROAM process is over (ROAM bit cleared)
7414 * 4. If a better network is found, a disassociation request is
7415 * sent.
7416 * 5. When the disassociation completes, the roam work is again
7417 * scheduled. The second time through, the driver is no longer
7418 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007419 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007420 * 6. At this point ,the roaming process is complete and the ROAM
7421 * status bit is cleared.
7422 */
7423
7424 /* If we are no longer associated, and the roaming bit is no longer
7425 * set, then we are not actively roaming, so just return */
7426 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7427 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007428
James Ketrenos43f66a62005-03-25 12:31:53 -06007429 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007430 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007431 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007432 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007433 u8 rssi = priv->assoc_network->stats.rssi;
7434 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007435 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007436 list_for_each_entry(network, &priv->ieee->network_list, list) {
7437 if (network != priv->assoc_network)
7438 ipw_best_network(priv, &match, network, 1);
7439 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007440 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007441 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007442
James Ketrenos43f66a62005-03-25 12:31:53 -06007443 if (match.network == priv->assoc_network) {
7444 IPW_DEBUG_ASSOC("No better APs in this network to "
7445 "roam to.\n");
7446 priv->status &= ~STATUS_ROAMING;
7447 ipw_debug_config(priv);
7448 return;
7449 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007450
James Ketrenos43f66a62005-03-25 12:31:53 -06007451 ipw_send_disassociate(priv, 1);
7452 priv->assoc_network = match.network;
7453
7454 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007455 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007456
7457 /* Second pass through ROAM process -- request association */
7458 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7459 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7460 priv->status &= ~STATUS_ROAMING;
7461}
7462
David Howellsc4028952006-11-22 14:57:56 +00007463static void ipw_bg_roam(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05007464{
David Howellsc4028952006-11-22 14:57:56 +00007465 struct ipw_priv *priv =
7466 container_of(work, struct ipw_priv, roam);
Zhu Yi46441512006-01-24 16:37:59 +08007467 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007468 ipw_roam(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007469 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007470}
7471
7472static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007473{
7474 struct ipw_priv *priv = data;
7475
7476 struct ieee80211_network *network = NULL;
7477 struct ipw_network_match match = {
7478 .network = NULL
7479 };
7480 struct ipw_supported_rates *rates;
7481 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007482 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007483
James Ketrenosb095c382005-08-24 22:04:42 -05007484 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7485 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7486 return 0;
7487 }
7488
James Ketrenosc848d0a2005-08-24 21:56:24 -05007489 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007490 IPW_DEBUG_ASSOC("Not attempting association (already in "
7491 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007492 return 0;
7493 }
7494
Hong Liue6324722005-09-14 21:04:15 -05007495 if (priv->status & STATUS_DISASSOCIATING) {
7496 IPW_DEBUG_ASSOC("Not attempting association (in "
7497 "disassociating)\n ");
7498 queue_work(priv->workqueue, &priv->associate);
7499 return 0;
7500 }
7501
James Ketrenosc848d0a2005-08-24 21:56:24 -05007502 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007503 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7504 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007505 return 0;
7506 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007507
7508 if (!(priv->config & CFG_ASSOCIATE) &&
7509 !(priv->config & (CFG_STATIC_ESSID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007510 CFG_STATIC_CHANNEL | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007511 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007512 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007513 }
7514
James Ketrenosa613bff2005-08-24 21:43:11 -05007515 /* Protect our use of the network_list */
7516 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007517 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007518 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007519
7520 network = match.network;
7521 rates = &match.rates;
7522
7523 if (network == NULL &&
7524 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7525 priv->config & CFG_ADHOC_CREATE &&
7526 priv->config & CFG_STATIC_ESSID &&
James Ketrenosa613bff2005-08-24 21:43:11 -05007527 priv->config & CFG_STATIC_CHANNEL &&
James Ketrenos43f66a62005-03-25 12:31:53 -06007528 !list_empty(&priv->ieee->network_free_list)) {
7529 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007530 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007531 ipw_adhoc_create(priv, network);
7532 rates = &priv->rates;
7533 list_del(element);
7534 list_add_tail(&network->list, &priv->ieee->network_list);
7535 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007536 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007537
James Ketrenos43f66a62005-03-25 12:31:53 -06007538 /* If we reached the end of the list, then we don't have any valid
7539 * matching APs */
7540 if (!network) {
7541 ipw_debug_config(priv);
7542
James Ketrenosb095c382005-08-24 22:04:42 -05007543 if (!(priv->status & STATUS_SCANNING)) {
7544 if (!(priv->config & CFG_SPEED_SCAN))
7545 queue_delayed_work(priv->workqueue,
7546 &priv->request_scan,
7547 SCAN_INTERVAL);
7548 else
David Howellsc4028952006-11-22 14:57:56 +00007549 queue_delayed_work(priv->workqueue,
7550 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05007551 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007552
James Ketrenosc848d0a2005-08-24 21:56:24 -05007553 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007554 }
7555
7556 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007557
7558 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007559}
Jeff Garzikbf794512005-07-31 13:07:26 -04007560
David Howellsc4028952006-11-22 14:57:56 +00007561static void ipw_bg_associate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06007562{
David Howellsc4028952006-11-22 14:57:56 +00007563 struct ipw_priv *priv =
7564 container_of(work, struct ipw_priv, associate);
Zhu Yi46441512006-01-24 16:37:59 +08007565 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007566 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007567 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007568}
7569
James Ketrenosb095c382005-08-24 22:04:42 -05007570static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7571 struct sk_buff *skb)
7572{
7573 struct ieee80211_hdr *hdr;
7574 u16 fc;
7575
7576 hdr = (struct ieee80211_hdr *)skb->data;
7577 fc = le16_to_cpu(hdr->frame_ctl);
7578 if (!(fc & IEEE80211_FCTL_PROTECTED))
7579 return;
7580
7581 fc &= ~IEEE80211_FCTL_PROTECTED;
7582 hdr->frame_ctl = cpu_to_le16(fc);
7583 switch (priv->ieee->sec.level) {
7584 case SEC_LEVEL_3:
7585 /* Remove CCMP HDR */
7586 memmove(skb->data + IEEE80211_3ADDR_LEN,
7587 skb->data + IEEE80211_3ADDR_LEN + 8,
7588 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007589 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007590 break;
7591 case SEC_LEVEL_2:
7592 break;
7593 case SEC_LEVEL_1:
7594 /* Remove IV */
7595 memmove(skb->data + IEEE80211_3ADDR_LEN,
7596 skb->data + IEEE80211_3ADDR_LEN + 4,
7597 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007598 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007599 break;
7600 case SEC_LEVEL_0:
7601 break;
7602 default:
7603 printk(KERN_ERR "Unknow security level %d\n",
7604 priv->ieee->sec.level);
7605 break;
7606 }
7607}
7608
7609static void ipw_handle_data_packet(struct ipw_priv *priv,
7610 struct ipw_rx_mem_buffer *rxb,
7611 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007612{
Hong Liu567deaf2005-08-31 18:07:22 +08007613 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007614 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7615
7616 /* We received data from the HW, so stop the watchdog */
7617 priv->net_dev->trans_start = jiffies;
7618
Jeff Garzikbf794512005-07-31 13:07:26 -04007619 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007620 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007621 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007622 skb_tailroom(rxb->skb))) {
7623 priv->ieee->stats.rx_errors++;
7624 priv->wstats.discard.misc++;
7625 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7626 return;
7627 } else if (unlikely(!netif_running(priv->net_dev))) {
7628 priv->ieee->stats.rx_dropped++;
7629 priv->wstats.discard.misc++;
7630 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7631 return;
7632 }
7633
7634 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007635 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007636
7637 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007638 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007639
7640 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7641
James Ketrenosb095c382005-08-24 22:04:42 -05007642 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007643 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7644 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007645 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007646 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007647 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7648
Jeff Garzikbf794512005-07-31 13:07:26 -04007649 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
James Ketrenos43f66a62005-03-25 12:31:53 -06007650 priv->ieee->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007651 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007652 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007653 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007654 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007655}
7656
Zhu Yi459d4082006-04-13 17:21:00 +08007657#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007658static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7659 struct ipw_rx_mem_buffer *rxb,
7660 struct ieee80211_rx_stats *stats)
7661{
7662 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7663 struct ipw_rx_frame *frame = &pkt->u.frame;
7664
7665 /* initial pull of some data */
7666 u16 received_channel = frame->received_channel;
7667 u8 antennaAndPhy = frame->antennaAndPhy;
7668 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7669 u16 pktrate = frame->rate;
7670
7671 /* Magic struct that slots into the radiotap header -- no reason
7672 * to build this manually element by element, we can write it much
7673 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007674 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007675
7676 short len = le16_to_cpu(pkt->u.frame.length);
7677
7678 /* We received data from the HW, so stop the watchdog */
7679 priv->net_dev->trans_start = jiffies;
7680
7681 /* We only process data packets if the
7682 * interface is open */
7683 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7684 skb_tailroom(rxb->skb))) {
7685 priv->ieee->stats.rx_errors++;
7686 priv->wstats.discard.misc++;
7687 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7688 return;
7689 } else if (unlikely(!netif_running(priv->net_dev))) {
7690 priv->ieee->stats.rx_dropped++;
7691 priv->wstats.discard.misc++;
7692 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7693 return;
7694 }
7695
7696 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7697 * that now */
7698 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7699 /* FIXME: Should alloc bigger skb instead */
7700 priv->ieee->stats.rx_dropped++;
7701 priv->wstats.discard.misc++;
7702 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7703 return;
7704 }
7705
7706 /* copy the frame itself */
7707 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7708 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7709
7710 /* Zero the radiotap static buffer ... We only need to zero the bytes NOT
7711 * part of our real header, saves a little time.
7712 *
7713 * No longer necessary since we fill in all our data. Purge before merging
7714 * patch officially.
7715 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7716 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7717 */
7718
7719 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7720
7721 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7722 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7723 ipw_rt->rt_hdr.it_len = sizeof(struct ipw_rt_hdr); /* total header+data */
7724
7725 /* Big bitfield of all the fields we provide in radiotap */
7726 ipw_rt->rt_hdr.it_present =
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007727 ((1 << IEEE80211_RADIOTAP_TSFT) |
7728 (1 << IEEE80211_RADIOTAP_FLAGS) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007729 (1 << IEEE80211_RADIOTAP_RATE) |
7730 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7731 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007732 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007733 (1 << IEEE80211_RADIOTAP_ANTENNA));
7734
7735 /* Zero the flags, we'll add to them as we go */
7736 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007737 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7738 frame->parent_tsf[2] << 16 |
7739 frame->parent_tsf[1] << 8 |
7740 frame->parent_tsf[0]);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007741
7742 /* Convert signal to DBM */
7743 ipw_rt->rt_dbmsignal = antsignal;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007744 ipw_rt->rt_dbmnoise = frame->noise;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007745
7746 /* Convert the channel data and set the flags */
7747 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7748 if (received_channel > 14) { /* 802.11a */
7749 ipw_rt->rt_chbitmask =
7750 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7751 } else if (antennaAndPhy & 32) { /* 802.11b */
7752 ipw_rt->rt_chbitmask =
7753 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7754 } else { /* 802.11g */
7755 ipw_rt->rt_chbitmask =
7756 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7757 }
7758
7759 /* set the rate in multiples of 500k/s */
7760 switch (pktrate) {
7761 case IPW_TX_RATE_1MB:
7762 ipw_rt->rt_rate = 2;
7763 break;
7764 case IPW_TX_RATE_2MB:
7765 ipw_rt->rt_rate = 4;
7766 break;
7767 case IPW_TX_RATE_5MB:
7768 ipw_rt->rt_rate = 10;
7769 break;
7770 case IPW_TX_RATE_6MB:
7771 ipw_rt->rt_rate = 12;
7772 break;
7773 case IPW_TX_RATE_9MB:
7774 ipw_rt->rt_rate = 18;
7775 break;
7776 case IPW_TX_RATE_11MB:
7777 ipw_rt->rt_rate = 22;
7778 break;
7779 case IPW_TX_RATE_12MB:
7780 ipw_rt->rt_rate = 24;
7781 break;
7782 case IPW_TX_RATE_18MB:
7783 ipw_rt->rt_rate = 36;
7784 break;
7785 case IPW_TX_RATE_24MB:
7786 ipw_rt->rt_rate = 48;
7787 break;
7788 case IPW_TX_RATE_36MB:
7789 ipw_rt->rt_rate = 72;
7790 break;
7791 case IPW_TX_RATE_48MB:
7792 ipw_rt->rt_rate = 96;
7793 break;
7794 case IPW_TX_RATE_54MB:
7795 ipw_rt->rt_rate = 108;
7796 break;
7797 default:
7798 ipw_rt->rt_rate = 0;
7799 break;
7800 }
7801
7802 /* antenna number */
7803 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7804
7805 /* set the preamble flag if we have it */
7806 if ((antennaAndPhy & 64))
7807 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7808
7809 /* Set the size of the skb to the size of the frame */
7810 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007811
7812 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7813
7814 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
7815 priv->ieee->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007816 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007817 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007818 /* no LED during capture */
7819 }
7820}
7821#endif
7822
Zhu Yid685b8c2006-04-13 17:20:27 +08007823#ifdef CONFIG_IPW2200_PROMISCUOUS
7824#define ieee80211_is_probe_response(fc) \
7825 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7826 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7827
7828#define ieee80211_is_management(fc) \
7829 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7830
7831#define ieee80211_is_control(fc) \
7832 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7833
7834#define ieee80211_is_data(fc) \
7835 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7836
7837#define ieee80211_is_assoc_request(fc) \
7838 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7839
7840#define ieee80211_is_reassoc_request(fc) \
7841 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7842
7843static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7844 struct ipw_rx_mem_buffer *rxb,
7845 struct ieee80211_rx_stats *stats)
7846{
7847 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7848 struct ipw_rx_frame *frame = &pkt->u.frame;
7849 struct ipw_rt_hdr *ipw_rt;
7850
7851 /* First cache any information we need before we overwrite
7852 * the information provided in the skb from the hardware */
7853 struct ieee80211_hdr *hdr;
7854 u16 channel = frame->received_channel;
7855 u8 phy_flags = frame->antennaAndPhy;
7856 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7857 s8 noise = frame->noise;
7858 u8 rate = frame->rate;
7859 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007860 struct sk_buff *skb;
7861 int hdr_only = 0;
7862 u16 filter = priv->prom_priv->filter;
7863
7864 /* If the filter is set to not include Rx frames then return */
7865 if (filter & IPW_PROM_NO_RX)
7866 return;
7867
Zhu Yid685b8c2006-04-13 17:20:27 +08007868 /* We received data from the HW, so stop the watchdog */
7869 priv->prom_net_dev->trans_start = jiffies;
7870
7871 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
7872 priv->prom_priv->ieee->stats.rx_errors++;
7873 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7874 return;
7875 }
7876
7877 /* We only process data packets if the interface is open */
7878 if (unlikely(!netif_running(priv->prom_net_dev))) {
7879 priv->prom_priv->ieee->stats.rx_dropped++;
7880 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7881 return;
7882 }
7883
7884 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7885 * that now */
7886 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7887 /* FIXME: Should alloc bigger skb instead */
7888 priv->prom_priv->ieee->stats.rx_dropped++;
7889 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7890 return;
7891 }
7892
7893 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
Zhu Yi851ca262006-08-21 11:37:58 +08007894 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007895 if (filter & IPW_PROM_NO_MGMT)
7896 return;
7897 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
7898 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007899 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007900 if (filter & IPW_PROM_NO_CTL)
7901 return;
7902 if (filter & IPW_PROM_CTL_HEADER_ONLY)
7903 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007904 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007905 if (filter & IPW_PROM_NO_DATA)
7906 return;
7907 if (filter & IPW_PROM_DATA_HEADER_ONLY)
7908 hdr_only = 1;
7909 }
7910
7911 /* Copy the SKB since this is for the promiscuous side */
7912 skb = skb_copy(rxb->skb, GFP_ATOMIC);
7913 if (skb == NULL) {
7914 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
7915 return;
7916 }
7917
7918 /* copy the frame data to write after where the radiotap header goes */
7919 ipw_rt = (void *)skb->data;
7920
7921 if (hdr_only)
Zhu Yi851ca262006-08-21 11:37:58 +08007922 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +08007923
7924 memcpy(ipw_rt->payload, hdr, len);
7925
7926 /* Zero the radiotap static buffer ... We only need to zero the bytes
7927 * NOT part of our real header, saves a little time.
7928 *
7929 * No longer necessary since we fill in all our data. Purge before
7930 * merging patch officially.
7931 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7932 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7933 */
7934
7935 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7936 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7937 ipw_rt->rt_hdr.it_len = sizeof(*ipw_rt); /* total header+data */
7938
7939 /* Set the size of the skb to the size of the frame */
7940 skb_put(skb, ipw_rt->rt_hdr.it_len + len);
7941
7942 /* Big bitfield of all the fields we provide in radiotap */
7943 ipw_rt->rt_hdr.it_present =
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007944 ((1 << IEEE80211_RADIOTAP_TSFT) |
7945 (1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007946 (1 << IEEE80211_RADIOTAP_RATE) |
7947 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7948 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
7949 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
7950 (1 << IEEE80211_RADIOTAP_ANTENNA));
7951
7952 /* Zero the flags, we'll add to them as we go */
7953 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007954 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7955 frame->parent_tsf[2] << 16 |
7956 frame->parent_tsf[1] << 8 |
7957 frame->parent_tsf[0]);
Zhu Yid685b8c2006-04-13 17:20:27 +08007958
7959 /* Convert to DBM */
7960 ipw_rt->rt_dbmsignal = signal;
7961 ipw_rt->rt_dbmnoise = noise;
7962
7963 /* Convert the channel data and set the flags */
7964 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
7965 if (channel > 14) { /* 802.11a */
7966 ipw_rt->rt_chbitmask =
7967 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7968 } else if (phy_flags & (1 << 5)) { /* 802.11b */
7969 ipw_rt->rt_chbitmask =
7970 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7971 } else { /* 802.11g */
7972 ipw_rt->rt_chbitmask =
7973 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7974 }
7975
7976 /* set the rate in multiples of 500k/s */
7977 switch (rate) {
7978 case IPW_TX_RATE_1MB:
7979 ipw_rt->rt_rate = 2;
7980 break;
7981 case IPW_TX_RATE_2MB:
7982 ipw_rt->rt_rate = 4;
7983 break;
7984 case IPW_TX_RATE_5MB:
7985 ipw_rt->rt_rate = 10;
7986 break;
7987 case IPW_TX_RATE_6MB:
7988 ipw_rt->rt_rate = 12;
7989 break;
7990 case IPW_TX_RATE_9MB:
7991 ipw_rt->rt_rate = 18;
7992 break;
7993 case IPW_TX_RATE_11MB:
7994 ipw_rt->rt_rate = 22;
7995 break;
7996 case IPW_TX_RATE_12MB:
7997 ipw_rt->rt_rate = 24;
7998 break;
7999 case IPW_TX_RATE_18MB:
8000 ipw_rt->rt_rate = 36;
8001 break;
8002 case IPW_TX_RATE_24MB:
8003 ipw_rt->rt_rate = 48;
8004 break;
8005 case IPW_TX_RATE_36MB:
8006 ipw_rt->rt_rate = 72;
8007 break;
8008 case IPW_TX_RATE_48MB:
8009 ipw_rt->rt_rate = 96;
8010 break;
8011 case IPW_TX_RATE_54MB:
8012 ipw_rt->rt_rate = 108;
8013 break;
8014 default:
8015 ipw_rt->rt_rate = 0;
8016 break;
8017 }
8018
8019 /* antenna number */
8020 ipw_rt->rt_antenna = (phy_flags & 3);
8021
8022 /* set the preamble flag if we have it */
8023 if (phy_flags & (1 << 6))
8024 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
8025
8026 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
8027
8028 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
8029 priv->prom_priv->ieee->stats.rx_errors++;
8030 dev_kfree_skb_any(skb);
8031 }
8032}
8033#endif
8034
Arjan van de Ven858119e2006-01-14 13:20:43 -08008035static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05008036 struct ieee80211_hdr_4addr *header)
8037{
8038 /* Filter incoming packets to determine if they are targetted toward
8039 * this network, discarding packets coming from ourselves */
8040 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05008041 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008042 /* packets from our adapter are dropped (echo) */
8043 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
8044 return 0;
8045
Peter Jones90700fd2005-08-26 16:51:06 -05008046 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008047 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05008048 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008049
8050 /* packets to our adapter go through */
8051 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8052 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008053
Peter Jones90700fd2005-08-26 16:51:06 -05008054 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008055 /* packets from our adapter are dropped (echo) */
8056 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
8057 return 0;
8058
Peter Jones90700fd2005-08-26 16:51:06 -05008059 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008060 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05008061 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
8062
8063 /* packets to our adapter go through */
8064 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8065 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05008066 }
James Ketrenosa613bff2005-08-24 21:43:11 -05008067
James Ketrenosea2b26e2005-08-24 21:25:16 -05008068 return 1;
8069}
8070
James Ketrenosafbf30a2005-08-25 00:05:33 -05008071#define IPW_PACKET_RETRY_TIME HZ
8072
Arjan van de Ven858119e2006-01-14 13:20:43 -08008073static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05008074 struct ieee80211_hdr_4addr *header)
8075{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008076 u16 sc = le16_to_cpu(header->seq_ctl);
8077 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8078 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8079 u16 *last_seq, *last_frag;
8080 unsigned long *last_time;
8081
8082 switch (priv->ieee->iw_mode) {
8083 case IW_MODE_ADHOC:
8084 {
8085 struct list_head *p;
8086 struct ipw_ibss_seq *entry = NULL;
8087 u8 *mac = header->addr2;
8088 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8089
8090 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8091 entry =
8092 list_entry(p, struct ipw_ibss_seq, list);
8093 if (!memcmp(entry->mac, mac, ETH_ALEN))
8094 break;
8095 }
8096 if (p == &priv->ibss_mac_hash[index]) {
8097 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8098 if (!entry) {
8099 IPW_ERROR
8100 ("Cannot malloc new mac entry\n");
8101 return 0;
8102 }
8103 memcpy(entry->mac, mac, ETH_ALEN);
8104 entry->seq_num = seq;
8105 entry->frag_num = frag;
8106 entry->packet_time = jiffies;
8107 list_add(&entry->list,
8108 &priv->ibss_mac_hash[index]);
8109 return 0;
8110 }
8111 last_seq = &entry->seq_num;
8112 last_frag = &entry->frag_num;
8113 last_time = &entry->packet_time;
8114 break;
8115 }
8116 case IW_MODE_INFRA:
8117 last_seq = &priv->last_seq_num;
8118 last_frag = &priv->last_frag_num;
8119 last_time = &priv->last_packet_time;
8120 break;
8121 default:
8122 return 0;
8123 }
8124 if ((*last_seq == seq) &&
8125 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8126 if (*last_frag == frag)
8127 goto drop;
8128 if (*last_frag + 1 != frag)
8129 /* out-of-order fragment */
8130 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008131 } else
8132 *last_seq = seq;
8133
Zhu Yif57ce7c2005-07-13 12:22:15 -05008134 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008135 *last_time = jiffies;
8136 return 0;
8137
8138 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008139 /* Comment this line now since we observed the card receives
8140 * duplicate packets but the FCTL_RETRY bit is not set in the
8141 * IBSS mode with fragmentation enabled.
8142 BUG_ON(!(le16_to_cpu(header->frame_ctl) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008143 return 1;
8144}
8145
James Ketrenosb095c382005-08-24 22:04:42 -05008146static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8147 struct ipw_rx_mem_buffer *rxb,
8148 struct ieee80211_rx_stats *stats)
8149{
8150 struct sk_buff *skb = rxb->skb;
8151 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8152 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8153 (skb->data + IPW_RX_FRAME_SIZE);
8154
8155 ieee80211_rx_mgt(priv->ieee, header, stats);
8156
8157 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8158 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8159 IEEE80211_STYPE_PROBE_RESP) ||
8160 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8161 IEEE80211_STYPE_BEACON))) {
8162 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8163 ipw_add_station(priv, header->addr2);
8164 }
8165
8166 if (priv->config & CFG_NET_STATS) {
8167 IPW_DEBUG_HC("sending stat packet\n");
8168
8169 /* Set the size of the skb to the size of the full
8170 * ipw header and 802.11 frame */
8171 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8172 IPW_RX_FRAME_SIZE);
8173
8174 /* Advance past the ipw packet header to the 802.11 frame */
8175 skb_pull(skb, IPW_RX_FRAME_SIZE);
8176
8177 /* Push the ieee80211_rx_stats before the 802.11 frame */
8178 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8179
8180 skb->dev = priv->ieee->dev;
8181
8182 /* Point raw at the ieee80211_stats */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07008183 skb_reset_mac_header(skb);
James Ketrenosb095c382005-08-24 22:04:42 -05008184
8185 skb->pkt_type = PACKET_OTHERHOST;
8186 skb->protocol = __constant_htons(ETH_P_80211_STATS);
8187 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8188 netif_rx(skb);
8189 rxb->skb = NULL;
8190 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008191}
8192
James Ketrenos43f66a62005-03-25 12:31:53 -06008193/*
8194 * Main entry function for recieving a packet with 80211 headers. This
8195 * should be called when ever the FW has notified us that there is a new
8196 * skb in the recieve queue.
8197 */
8198static void ipw_rx(struct ipw_priv *priv)
8199{
8200 struct ipw_rx_mem_buffer *rxb;
8201 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008202 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008203 u32 r, w, i;
8204 u8 network_packet;
8205
James Ketrenosb095c382005-08-24 22:04:42 -05008206 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8207 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
James Ketrenos43f66a62005-03-25 12:31:53 -06008208 i = (priv->rxq->processed + 1) % RX_QUEUE_SIZE;
8209
8210 while (i != r) {
8211 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008212 if (unlikely(rxb == NULL)) {
8213 printk(KERN_CRIT "Queue not allocated!\n");
8214 break;
8215 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008216 priv->rxq->queue[i] = NULL;
8217
8218 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008219 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008220 PCI_DMA_FROMDEVICE);
8221
8222 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8223 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8224 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008225 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008226
8227 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008228 case RX_FRAME_TYPE: /* 802.11 frame */ {
8229 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008230 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008231 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008232 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008233 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8234 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008235 .noise =
8236 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008237 .rate = pkt->u.frame.rate,
8238 .mac_time = jiffies,
8239 .received_channel =
8240 pkt->u.frame.received_channel,
8241 .freq =
8242 (pkt->u.frame.
8243 control & (1 << 0)) ?
8244 IEEE80211_24GHZ_BAND :
8245 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008246 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008247 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008248
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008249 if (stats.rssi != 0)
8250 stats.mask |= IEEE80211_STATMASK_RSSI;
8251 if (stats.signal != 0)
8252 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008253 if (stats.noise != 0)
8254 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008255 if (stats.rate != 0)
8256 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008257
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008258 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008259
Zhu Yid685b8c2006-04-13 17:20:27 +08008260#ifdef CONFIG_IPW2200_PROMISCUOUS
8261 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8262 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8263#endif
8264
James Ketrenosb095c382005-08-24 22:04:42 -05008265#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008266 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008267#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008268
8269 ipw_handle_data_packet_monitor(priv,
8270 rxb,
8271 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008272#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008273 ipw_handle_data_packet(priv, rxb,
8274 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008275#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008276 break;
8277 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008278#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008279
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008280 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008281 (struct ieee80211_hdr_4addr *)(rxb->skb->
8282 data +
8283 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008284 /* TODO: Check Ad-Hoc dest/source and make sure
8285 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008286 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008287 * frame control of the packet and disregard
8288 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008289
James Ketrenosea2b26e2005-08-24 21:25:16 -05008290 network_packet =
8291 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008292 if (network_packet && priv->assoc_network) {
8293 priv->assoc_network->stats.rssi =
8294 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008295 priv->exp_avg_rssi =
8296 exponential_average(priv->exp_avg_rssi,
8297 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008298 }
8299
8300 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008301 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008302
James Ketrenosa613bff2005-08-24 21:43:11 -05008303 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008304 ieee80211_get_hdrlen(le16_to_cpu(
8305 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008306 IPW_DEBUG_DROP
8307 ("Received packet is too small. "
8308 "Dropping.\n");
8309 priv->ieee->stats.rx_errors++;
8310 priv->wstats.discard.misc++;
8311 break;
8312 }
8313
James Ketrenosa613bff2005-08-24 21:43:11 -05008314 switch (WLAN_FC_GET_TYPE
8315 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008316
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008317 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008318 ipw_handle_mgmt_packet(priv, rxb,
8319 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008320 break;
8321
8322 case IEEE80211_FTYPE_CTL:
8323 break;
8324
8325 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008326 if (unlikely(!network_packet ||
8327 is_duplicate_packet(priv,
8328 header)))
8329 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008330 IPW_DEBUG_DROP("Dropping: "
8331 MAC_FMT ", "
8332 MAC_FMT ", "
8333 MAC_FMT "\n",
8334 MAC_ARG(header->
8335 addr1),
8336 MAC_ARG(header->
8337 addr2),
8338 MAC_ARG(header->
8339 addr3));
James Ketrenosb095c382005-08-24 22:04:42 -05008340 break;
8341 }
8342
8343 ipw_handle_data_packet(priv, rxb,
8344 &stats);
8345
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008346 break;
8347 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008348 break;
8349 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008350
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008351 case RX_HOST_NOTIFICATION_TYPE:{
8352 IPW_DEBUG_RX
8353 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008354 pkt->u.notification.subtype,
8355 pkt->u.notification.flags,
Zhu Yi720eeb42006-12-05 14:41:40 +08008356 le16_to_cpu(pkt->u.notification.size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008357 ipw_rx_notification(priv, &pkt->u.notification);
8358 break;
8359 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008360
8361 default:
8362 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8363 pkt->header.message_type);
8364 break;
8365 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008366
8367 /* For now we just don't re-use anything. We can tweak this
8368 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008369 * fail to Rx correctly */
8370 if (rxb->skb != NULL) {
8371 dev_kfree_skb_any(rxb->skb);
8372 rxb->skb = NULL;
8373 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008374
James Ketrenos43f66a62005-03-25 12:31:53 -06008375 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008376 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008377 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008378
James Ketrenos43f66a62005-03-25 12:31:53 -06008379 i = (i + 1) % RX_QUEUE_SIZE;
8380 }
8381
8382 /* Backtrack one entry */
8383 priv->rxq->processed = (i ? i : RX_QUEUE_SIZE) - 1;
8384
8385 ipw_rx_queue_restock(priv);
8386}
8387
James Ketrenosafbf30a2005-08-25 00:05:33 -05008388#define DEFAULT_RTS_THRESHOLD 2304U
8389#define MIN_RTS_THRESHOLD 1U
8390#define MAX_RTS_THRESHOLD 2304U
8391#define DEFAULT_BEACON_INTERVAL 100U
8392#define DEFAULT_SHORT_RETRY_LIMIT 7U
8393#define DEFAULT_LONG_RETRY_LIMIT 4U
8394
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008395/**
8396 * ipw_sw_reset
8397 * @option: options to control different reset behaviour
8398 * 0 = reset everything except the 'disable' module_param
8399 * 1 = reset everything and print out driver info (for probe only)
8400 * 2 = reset everything
8401 */
8402static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008403{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008404 int band, modulation;
8405 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008406
James Ketrenosafbf30a2005-08-25 00:05:33 -05008407 /* Initialize module parameter values here */
8408 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008409
James Ketrenosafbf30a2005-08-25 00:05:33 -05008410 /* We default to disabling the LED code as right now it causes
8411 * too many systems to lock up... */
8412 if (!led)
8413 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008414
James Ketrenosafbf30a2005-08-25 00:05:33 -05008415 if (associate)
8416 priv->config |= CFG_ASSOCIATE;
8417 else
8418 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008419
James Ketrenosafbf30a2005-08-25 00:05:33 -05008420 if (auto_create)
8421 priv->config |= CFG_ADHOC_CREATE;
8422 else
8423 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8424
Zhu Yi17ed0812006-01-24 16:36:31 +08008425 priv->config &= ~CFG_STATIC_ESSID;
8426 priv->essid_len = 0;
8427 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8428
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008429 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008430 priv->status |= STATUS_RF_KILL_SW;
8431 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008432 }
8433
James Ketrenosafbf30a2005-08-25 00:05:33 -05008434 if (channel != 0) {
8435 priv->config |= CFG_STATIC_CHANNEL;
8436 priv->channel = channel;
8437 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8438 /* TODO: Validate that provided channel is in range */
8439 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008440#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008441 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8442 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008443#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008444
8445 switch (mode) {
8446 case 1:
8447 priv->ieee->iw_mode = IW_MODE_ADHOC;
8448 priv->net_dev->type = ARPHRD_ETHER;
8449
8450 break;
8451#ifdef CONFIG_IPW2200_MONITOR
8452 case 2:
8453 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008454#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008455 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8456#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008457 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008458#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008459 break;
8460#endif
8461 default:
8462 case 0:
8463 priv->net_dev->type = ARPHRD_ETHER;
8464 priv->ieee->iw_mode = IW_MODE_INFRA;
8465 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008466 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008467
James Ketrenosafbf30a2005-08-25 00:05:33 -05008468 if (hwcrypto) {
8469 priv->ieee->host_encrypt = 0;
8470 priv->ieee->host_encrypt_msdu = 0;
8471 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008472 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008473 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008474 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008475
Zhu Yie402c932005-08-05 17:20:40 +08008476 /* IPW2200/2915 is abled to do hardware fragmentation. */
8477 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008478
James Ketrenosafbf30a2005-08-25 00:05:33 -05008479 if ((priv->pci_dev->device == 0x4223) ||
8480 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008481 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008482 printk(KERN_INFO DRV_NAME
8483 ": Detected Intel PRO/Wireless 2915ABG Network "
8484 "Connection\n");
8485 priv->ieee->abg_true = 1;
8486 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8487 modulation = IEEE80211_OFDM_MODULATION |
8488 IEEE80211_CCK_MODULATION;
8489 priv->adapter = IPW_2915ABG;
8490 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008491 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008492 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008493 printk(KERN_INFO DRV_NAME
8494 ": Detected Intel PRO/Wireless 2200BG Network "
8495 "Connection\n");
8496
8497 priv->ieee->abg_true = 0;
8498 band = IEEE80211_24GHZ_BAND;
8499 modulation = IEEE80211_OFDM_MODULATION |
8500 IEEE80211_CCK_MODULATION;
8501 priv->adapter = IPW_2200BG;
8502 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008503 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008504
James Ketrenosafbf30a2005-08-25 00:05:33 -05008505 priv->ieee->freq_band = band;
8506 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008507
James Ketrenosafbf30a2005-08-25 00:05:33 -05008508 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008509
James Ketrenosafbf30a2005-08-25 00:05:33 -05008510 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8511 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008512
James Ketrenosafbf30a2005-08-25 00:05:33 -05008513 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8514 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8515 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008516
James Ketrenosafbf30a2005-08-25 00:05:33 -05008517 /* If power management is turned on, default to AC mode */
8518 priv->power_mode = IPW_POWER_AC;
8519 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008520
Zhu Yi0ece35b2005-08-05 17:26:51 +08008521 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008522}
8523
8524/*
8525 * This file defines the Wireless Extension handlers. It does not
8526 * define any methods of hardware manipulation and relies on the
8527 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008528 *
8529 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008530 * function used to poll the hardware vs. making unecessary calls.
8531 *
8532 */
8533
Jeff Garzikbf794512005-07-31 13:07:26 -04008534static int ipw_wx_get_name(struct net_device *dev,
8535 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008536 union iwreq_data *wrqu, char *extra)
8537{
8538 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008539 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008540 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008541 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008542 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008543 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008544 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008545 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8546 ipw_modes[priv->assoc_request.ieee_mode]);
8547 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008548 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008549 return 0;
8550}
8551
8552static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8553{
8554 if (channel == 0) {
8555 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8556 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008557 IPW_DEBUG_ASSOC("Attempting to associate with new "
8558 "parameters.\n");
8559 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008560 return 0;
8561 }
8562
8563 priv->config |= CFG_STATIC_CHANNEL;
8564
8565 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008566 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8567 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008568 return 0;
8569 }
8570
8571 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8572 priv->channel = channel;
8573
James Ketrenosb095c382005-08-24 22:04:42 -05008574#ifdef CONFIG_IPW2200_MONITOR
8575 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008576 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008577 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008578 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008579 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008580 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008581 }
8582
8583 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8584 udelay(10);
8585
8586 if (priv->status & STATUS_SCANNING)
8587 IPW_DEBUG_SCAN("Still scanning...\n");
8588 else
8589 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8590 1000 - i);
8591
8592 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008593 }
James Ketrenosb095c382005-08-24 22:04:42 -05008594#endif /* CONFIG_IPW2200_MONITOR */
8595
James Ketrenosc848d0a2005-08-24 21:56:24 -05008596 /* Network configuration changed -- force [re]association */
8597 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8598 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008599 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008600
8601 return 0;
8602}
8603
Jeff Garzikbf794512005-07-31 13:07:26 -04008604static int ipw_wx_set_freq(struct net_device *dev,
8605 struct iw_request_info *info,
8606 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008607{
8608 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008609 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008610 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008611 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008612 u8 channel, flags;
8613 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008614
James Ketrenosb095c382005-08-24 22:04:42 -05008615 if (fwrq->m == 0) {
8616 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008617 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008618 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008619 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008620 return ret;
8621 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008622 /* if setting by freq convert to channel */
8623 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008624 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008625 if (channel == 0)
8626 return -EINVAL;
8627 } else
8628 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008629
Larry Finger1867b112006-02-28 09:48:28 -06008630 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008631 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008632
Liu Hong1fe0adb2005-08-19 09:33:10 -05008633 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008634 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008635 if (i == -1)
8636 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008637
8638 flags = (band == IEEE80211_24GHZ_BAND) ?
8639 geo->bg[i].flags : geo->a[i].flags;
8640 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008641 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8642 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008643 }
8644 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008645
James Ketrenos43f66a62005-03-25 12:31:53 -06008646 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008647 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008648 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008649 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008650 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008651}
8652
Jeff Garzikbf794512005-07-31 13:07:26 -04008653static int ipw_wx_get_freq(struct net_device *dev,
8654 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008655 union iwreq_data *wrqu, char *extra)
8656{
8657 struct ipw_priv *priv = ieee80211_priv(dev);
8658
8659 wrqu->freq.e = 0;
8660
8661 /* If we are associated, trying to associate, or have a statically
8662 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008663 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008664 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008665 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8666 int i;
8667
8668 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8669 BUG_ON(i == -1);
8670 wrqu->freq.e = 1;
8671
8672 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8673 case IEEE80211_52GHZ_BAND:
8674 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8675 break;
8676
8677 case IEEE80211_24GHZ_BAND:
8678 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8679 break;
8680
8681 default:
8682 BUG();
8683 }
8684 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008685 wrqu->freq.m = 0;
8686
Zhu Yi46441512006-01-24 16:37:59 +08008687 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008688 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8689 return 0;
8690}
8691
Jeff Garzikbf794512005-07-31 13:07:26 -04008692static int ipw_wx_set_mode(struct net_device *dev,
8693 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008694 union iwreq_data *wrqu, char *extra)
8695{
8696 struct ipw_priv *priv = ieee80211_priv(dev);
8697 int err = 0;
8698
8699 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8700
James Ketrenos43f66a62005-03-25 12:31:53 -06008701 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008702#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008703 case IW_MODE_MONITOR:
8704#endif
8705 case IW_MODE_ADHOC:
8706 case IW_MODE_INFRA:
8707 break;
8708 case IW_MODE_AUTO:
8709 wrqu->mode = IW_MODE_INFRA;
8710 break;
8711 default:
8712 return -EINVAL;
8713 }
James Ketrenosb095c382005-08-24 22:04:42 -05008714 if (wrqu->mode == priv->ieee->iw_mode)
8715 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008716
Zhu Yi46441512006-01-24 16:37:59 +08008717 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008718
8719 ipw_sw_reset(priv, 0);
8720
James Ketrenosb095c382005-08-24 22:04:42 -05008721#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008722 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008723 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008724
8725 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008726#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008727 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8728#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008729 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008730#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008731#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008732
Jeff Garzikbf794512005-07-31 13:07:26 -04008733 /* Free the existing firmware and reset the fw_loaded
James Ketrenos43f66a62005-03-25 12:31:53 -06008734 * flag so ipw_load() will bring in the new firmawre */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008735 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008736
8737 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008738
James Ketrenosc848d0a2005-08-24 21:56:24 -05008739 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008740 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008741 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008742}
8743
Jeff Garzikbf794512005-07-31 13:07:26 -04008744static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008745 struct iw_request_info *info,
8746 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008747{
8748 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008749 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008750 wrqu->mode = priv->ieee->iw_mode;
8751 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008752 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008753 return 0;
8754}
8755
James Ketrenos43f66a62005-03-25 12:31:53 -06008756/* Values are in microsecond */
8757static const s32 timeout_duration[] = {
8758 350000,
8759 250000,
8760 75000,
8761 37000,
8762 25000,
8763};
8764
8765static const s32 period_duration[] = {
8766 400000,
8767 700000,
8768 1000000,
8769 1000000,
8770 1000000
8771};
8772
Jeff Garzikbf794512005-07-31 13:07:26 -04008773static int ipw_wx_get_range(struct net_device *dev,
8774 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008775 union iwreq_data *wrqu, char *extra)
8776{
8777 struct ipw_priv *priv = ieee80211_priv(dev);
8778 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008779 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008780 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008781
8782 wrqu->data.length = sizeof(*range);
8783 memset(range, 0, sizeof(*range));
8784
8785 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008786 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008787
8788 range->max_qual.qual = 100;
8789 /* TODO: Find real max RSSI and stick here */
8790 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008791 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008792 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008793
8794 range->avg_qual.qual = 70;
8795 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008796 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008797 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008798 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008799 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008800 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008801
Jeff Garzikbf794512005-07-31 13:07:26 -04008802 for (i = 0; i < range->num_bitrates; i++)
8803 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008804 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008805
James Ketrenos43f66a62005-03-25 12:31:53 -06008806 range->max_rts = DEFAULT_RTS_THRESHOLD;
8807 range->min_frag = MIN_FRAG_THRESHOLD;
8808 range->max_frag = MAX_FRAG_THRESHOLD;
8809
8810 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008811 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008812 range->num_encoding_sizes = 2;
8813 range->max_encoding_tokens = WEP_KEYS;
8814
8815 /* Set the Wireless Extension versions */
8816 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008817 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008818
James Ketrenosb095c382005-08-24 22:04:42 -05008819 i = 0;
8820 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008821 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8822 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8823 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8824 continue;
8825
James Ketrenosb095c382005-08-24 22:04:42 -05008826 range->freq[i].i = geo->bg[j].channel;
8827 range->freq[i].m = geo->bg[j].freq * 100000;
8828 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008829 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008830 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008831 }
James Ketrenosb095c382005-08-24 22:04:42 -05008832
8833 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008834 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8835 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8836 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8837 continue;
8838
James Ketrenosb095c382005-08-24 22:04:42 -05008839 range->freq[i].i = geo->a[j].channel;
8840 range->freq[i].m = geo->a[j].freq * 100000;
8841 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008842 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008843 }
8844 }
8845
8846 range->num_channels = i;
8847 range->num_frequency = i;
8848
Zhu Yi46441512006-01-24 16:37:59 +08008849 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008850
8851 /* Event capability (kernel + driver) */
8852 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8853 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008854 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8855 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008856 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008857
Dan Williamsf1b50862006-01-30 13:58:56 -05008858 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8859 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8860
James Ketrenos43f66a62005-03-25 12:31:53 -06008861 IPW_DEBUG_WX("GET Range\n");
8862 return 0;
8863}
8864
Jeff Garzikbf794512005-07-31 13:07:26 -04008865static int ipw_wx_set_wap(struct net_device *dev,
8866 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008867 union iwreq_data *wrqu, char *extra)
8868{
8869 struct ipw_priv *priv = ieee80211_priv(dev);
8870
8871 static const unsigned char any[] = {
8872 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8873 };
8874 static const unsigned char off[] = {
8875 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8876 };
8877
Jeff Garzikbf794512005-07-31 13:07:26 -04008878 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008879 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008880 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008881 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8882 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8883 /* we disable mandatory BSSID association */
8884 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8885 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008886 IPW_DEBUG_ASSOC("Attempting to associate with new "
8887 "parameters.\n");
8888 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08008889 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008890 return 0;
8891 }
8892
8893 priv->config |= CFG_STATIC_BSSID;
8894 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8895 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008896 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008897 return 0;
8898 }
8899
8900 IPW_DEBUG_WX("Setting mandatory BSSID to " MAC_FMT "\n",
8901 MAC_ARG(wrqu->ap_addr.sa_data));
8902
8903 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
8904
James Ketrenosc848d0a2005-08-24 21:56:24 -05008905 /* Network configuration changed -- force [re]association */
8906 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
8907 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008908 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008909
Zhu Yi46441512006-01-24 16:37:59 +08008910 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008911 return 0;
8912}
8913
Jeff Garzikbf794512005-07-31 13:07:26 -04008914static int ipw_wx_get_wap(struct net_device *dev,
8915 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008916 union iwreq_data *wrqu, char *extra)
8917{
8918 struct ipw_priv *priv = ieee80211_priv(dev);
8919 /* If we are associated, trying to associate, or have a statically
8920 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008921 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04008922 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06008923 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8924 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008925 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06008926 } else
8927 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8928
8929 IPW_DEBUG_WX("Getting WAP BSSID: " MAC_FMT "\n",
8930 MAC_ARG(wrqu->ap_addr.sa_data));
Zhu Yi46441512006-01-24 16:37:59 +08008931 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008932 return 0;
8933}
8934
Jeff Garzikbf794512005-07-31 13:07:26 -04008935static int ipw_wx_set_essid(struct net_device *dev,
8936 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008937 union iwreq_data *wrqu, char *extra)
8938{
8939 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08008940 int length;
James Ketrenos43f66a62005-03-25 12:31:53 -06008941
Zhu Yiab644b02006-08-21 11:37:13 +08008942 mutex_lock(&priv->mutex);
8943
8944 if (!wrqu->essid.flags)
8945 {
8946 IPW_DEBUG_WX("Setting ESSID to ANY\n");
8947 ipw_disassociate(priv);
8948 priv->config &= ~CFG_STATIC_ESSID;
8949 ipw_associate(priv);
8950 mutex_unlock(&priv->mutex);
8951 return 0;
8952 }
8953
Zhu Yia9f0d422006-08-21 11:37:26 +08008954 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008955
8956 priv->config |= CFG_STATIC_ESSID;
8957
Zhu Yia9f0d422006-08-21 11:37:26 +08008958 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
8959 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06008960 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008961 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008962 return 0;
8963 }
8964
Zhu Yiab644b02006-08-21 11:37:13 +08008965 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n", escape_essid(extra, length),
James Ketrenos43f66a62005-03-25 12:31:53 -06008966 length);
8967
8968 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08008969 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04008970
James Ketrenosc848d0a2005-08-24 21:56:24 -05008971 /* Network configuration changed -- force [re]association */
8972 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
8973 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008974 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008975
Zhu Yi46441512006-01-24 16:37:59 +08008976 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008977 return 0;
8978}
8979
Jeff Garzikbf794512005-07-31 13:07:26 -04008980static int ipw_wx_get_essid(struct net_device *dev,
8981 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008982 union iwreq_data *wrqu, char *extra)
8983{
8984 struct ipw_priv *priv = ieee80211_priv(dev);
8985
8986 /* If we are associated, trying to associate, or have a statically
8987 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008988 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008989 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04008990 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8991 IPW_DEBUG_WX("Getting essid: '%s'\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008992 escape_essid(priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04008993 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06008994 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008995 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06008996 } else {
8997 IPW_DEBUG_WX("Getting essid: ANY\n");
8998 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008999 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009000 }
Zhu Yi46441512006-01-24 16:37:59 +08009001 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009002 return 0;
9003}
9004
Jeff Garzikbf794512005-07-31 13:07:26 -04009005static int ipw_wx_set_nick(struct net_device *dev,
9006 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009007 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009008{
James Ketrenos43f66a62005-03-25 12:31:53 -06009009 struct ipw_priv *priv = ieee80211_priv(dev);
9010
9011 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
9012 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
9013 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08009014 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009015 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06009016 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009017 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009018 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08009019 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009020 return 0;
9021
9022}
9023
Jeff Garzikbf794512005-07-31 13:07:26 -04009024static int ipw_wx_get_nick(struct net_device *dev,
9025 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009026 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009027{
James Ketrenos43f66a62005-03-25 12:31:53 -06009028 struct ipw_priv *priv = ieee80211_priv(dev);
9029 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08009030 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009031 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06009032 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009033 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08009034 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009035 return 0;
9036}
9037
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009038static int ipw_wx_set_sens(struct net_device *dev,
9039 struct iw_request_info *info,
9040 union iwreq_data *wrqu, char *extra)
9041{
9042 struct ipw_priv *priv = ieee80211_priv(dev);
9043 int err = 0;
9044
9045 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
9046 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
9047 mutex_lock(&priv->mutex);
9048
9049 if (wrqu->sens.fixed == 0)
9050 {
9051 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
9052 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
9053 goto out;
9054 }
9055 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
9056 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
9057 err = -EINVAL;
9058 goto out;
9059 }
9060
9061 priv->roaming_threshold = wrqu->sens.value;
9062 priv->disassociate_threshold = 3*wrqu->sens.value;
9063 out:
9064 mutex_unlock(&priv->mutex);
9065 return err;
9066}
9067
9068static int ipw_wx_get_sens(struct net_device *dev,
9069 struct iw_request_info *info,
9070 union iwreq_data *wrqu, char *extra)
9071{
9072 struct ipw_priv *priv = ieee80211_priv(dev);
9073 mutex_lock(&priv->mutex);
9074 wrqu->sens.fixed = 1;
9075 wrqu->sens.value = priv->roaming_threshold;
9076 mutex_unlock(&priv->mutex);
9077
9078 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9079 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9080
9081 return 0;
9082}
9083
James Ketrenos43f66a62005-03-25 12:31:53 -06009084static int ipw_wx_set_rate(struct net_device *dev,
9085 struct iw_request_info *info,
9086 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009087{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009088 /* TODO: We should use semaphores or locks for access to priv */
9089 struct ipw_priv *priv = ieee80211_priv(dev);
9090 u32 target_rate = wrqu->bitrate.value;
9091 u32 fixed, mask;
9092
9093 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9094 /* value = X, fixed = 1 means only rate X */
9095 /* value = X, fixed = 0 means all rates lower equal X */
9096
9097 if (target_rate == -1) {
9098 fixed = 0;
9099 mask = IEEE80211_DEFAULT_RATES_MASK;
9100 /* Now we should reassociate */
9101 goto apply;
9102 }
9103
9104 mask = 0;
9105 fixed = wrqu->bitrate.fixed;
9106
9107 if (target_rate == 1000000 || !fixed)
9108 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9109 if (target_rate == 1000000)
9110 goto apply;
9111
9112 if (target_rate == 2000000 || !fixed)
9113 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9114 if (target_rate == 2000000)
9115 goto apply;
9116
9117 if (target_rate == 5500000 || !fixed)
9118 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9119 if (target_rate == 5500000)
9120 goto apply;
9121
9122 if (target_rate == 6000000 || !fixed)
9123 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9124 if (target_rate == 6000000)
9125 goto apply;
9126
9127 if (target_rate == 9000000 || !fixed)
9128 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9129 if (target_rate == 9000000)
9130 goto apply;
9131
9132 if (target_rate == 11000000 || !fixed)
9133 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9134 if (target_rate == 11000000)
9135 goto apply;
9136
9137 if (target_rate == 12000000 || !fixed)
9138 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9139 if (target_rate == 12000000)
9140 goto apply;
9141
9142 if (target_rate == 18000000 || !fixed)
9143 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9144 if (target_rate == 18000000)
9145 goto apply;
9146
9147 if (target_rate == 24000000 || !fixed)
9148 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9149 if (target_rate == 24000000)
9150 goto apply;
9151
9152 if (target_rate == 36000000 || !fixed)
9153 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9154 if (target_rate == 36000000)
9155 goto apply;
9156
9157 if (target_rate == 48000000 || !fixed)
9158 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9159 if (target_rate == 48000000)
9160 goto apply;
9161
9162 if (target_rate == 54000000 || !fixed)
9163 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9164 if (target_rate == 54000000)
9165 goto apply;
9166
9167 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9168 return -EINVAL;
9169
9170 apply:
9171 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9172 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009173 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009174 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009175 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009176 ipw_set_fixed_rate(priv, priv->ieee->mode);
9177 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009178 priv->config |= CFG_FIXED_RATE;
9179
James Ketrenosc848d0a2005-08-24 21:56:24 -05009180 if (priv->rates_mask == mask) {
9181 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009182 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009183 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009184 }
9185
James Ketrenosc848d0a2005-08-24 21:56:24 -05009186 priv->rates_mask = mask;
9187
9188 /* Network configuration changed -- force [re]association */
9189 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9190 if (!ipw_disassociate(priv))
9191 ipw_associate(priv);
9192
Zhu Yi46441512006-01-24 16:37:59 +08009193 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009194 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009195}
9196
Jeff Garzikbf794512005-07-31 13:07:26 -04009197static int ipw_wx_get_rate(struct net_device *dev,
9198 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009199 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009200{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009201 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009202 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009203 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009204 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009205 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009206 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9207 return 0;
9208}
9209
Jeff Garzikbf794512005-07-31 13:07:26 -04009210static int ipw_wx_set_rts(struct net_device *dev,
9211 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009212 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009213{
James Ketrenos43f66a62005-03-25 12:31:53 -06009214 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009215 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009216 if (wrqu->rts.disabled || !wrqu->rts.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009217 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9218 else {
9219 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009220 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009221 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009222 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009223 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009224 priv->rts_threshold = wrqu->rts.value;
9225 }
9226
9227 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009228 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009229 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9230 return 0;
9231}
9232
Jeff Garzikbf794512005-07-31 13:07:26 -04009233static int ipw_wx_get_rts(struct net_device *dev,
9234 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009235 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009236{
James Ketrenos43f66a62005-03-25 12:31:53 -06009237 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009238 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009239 wrqu->rts.value = priv->rts_threshold;
9240 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009241 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009242 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009243 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9244 return 0;
9245}
9246
Jeff Garzikbf794512005-07-31 13:07:26 -04009247static int ipw_wx_set_txpow(struct net_device *dev,
9248 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009249 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009250{
James Ketrenos43f66a62005-03-25 12:31:53 -06009251 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009252 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009253
Zhu Yi46441512006-01-24 16:37:59 +08009254 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009255 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009256 err = -EINPROGRESS;
9257 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009258 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009259
James Ketrenosb095c382005-08-24 22:04:42 -05009260 if (!wrqu->power.fixed)
9261 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009262
James Ketrenosc848d0a2005-08-24 21:56:24 -05009263 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009264 err = -EINVAL;
9265 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009266 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009267
James Ketrenosb095c382005-08-24 22:04:42 -05009268 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009269 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009270 err = -EINVAL;
9271 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009272 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009273
9274 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009275 err = ipw_set_tx_power(priv);
9276 out:
Zhu Yi46441512006-01-24 16:37:59 +08009277 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009278 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009279}
9280
Jeff Garzikbf794512005-07-31 13:07:26 -04009281static int ipw_wx_get_txpow(struct net_device *dev,
9282 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009283 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009284{
James Ketrenos43f66a62005-03-25 12:31:53 -06009285 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009286 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009287 wrqu->power.value = priv->tx_power;
9288 wrqu->power.fixed = 1;
9289 wrqu->power.flags = IW_TXPOW_DBM;
9290 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009291 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009292
Jeff Garzikbf794512005-07-31 13:07:26 -04009293 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009294 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009295
9296 return 0;
9297}
9298
Jeff Garzikbf794512005-07-31 13:07:26 -04009299static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009300 struct iw_request_info *info,
9301 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009302{
9303 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009304 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009305 if (wrqu->frag.disabled || !wrqu->frag.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009306 priv->ieee->fts = DEFAULT_FTS;
9307 else {
9308 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009309 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009310 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009311 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009312 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009313
James Ketrenos43f66a62005-03-25 12:31:53 -06009314 priv->ieee->fts = wrqu->frag.value & ~0x1;
9315 }
9316
9317 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009318 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009319 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9320 return 0;
9321}
9322
Jeff Garzikbf794512005-07-31 13:07:26 -04009323static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009324 struct iw_request_info *info,
9325 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009326{
9327 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009328 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009329 wrqu->frag.value = priv->ieee->fts;
9330 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009331 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009332 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009333 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9334
9335 return 0;
9336}
9337
Jeff Garzikbf794512005-07-31 13:07:26 -04009338static int ipw_wx_set_retry(struct net_device *dev,
9339 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009340 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009341{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009342 struct ipw_priv *priv = ieee80211_priv(dev);
9343
9344 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9345 return -EINVAL;
9346
9347 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9348 return 0;
9349
Zhu Yid5f7ac22006-08-21 11:38:17 +08009350 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009351 return -EINVAL;
9352
Zhu Yi46441512006-01-24 16:37:59 +08009353 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009354 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009355 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009356 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009357 priv->long_retry_limit = (u8) wrqu->retry.value;
9358 else {
9359 priv->short_retry_limit = (u8) wrqu->retry.value;
9360 priv->long_retry_limit = (u8) wrqu->retry.value;
9361 }
9362
9363 ipw_send_retry_limit(priv, priv->short_retry_limit,
9364 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009365 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009366 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9367 priv->short_retry_limit, priv->long_retry_limit);
9368 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009369}
9370
Jeff Garzikbf794512005-07-31 13:07:26 -04009371static int ipw_wx_get_retry(struct net_device *dev,
9372 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009373 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009374{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009375 struct ipw_priv *priv = ieee80211_priv(dev);
9376
Zhu Yi46441512006-01-24 16:37:59 +08009377 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009378 wrqu->retry.disabled = 0;
9379
9380 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009381 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009382 return -EINVAL;
9383 }
9384
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009385 if (wrqu->retry.flags & IW_RETRY_LONG) {
9386 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009387 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009388 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9389 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009390 wrqu->retry.value = priv->short_retry_limit;
9391 } else {
9392 wrqu->retry.flags = IW_RETRY_LIMIT;
9393 wrqu->retry.value = priv->short_retry_limit;
9394 }
Zhu Yi46441512006-01-24 16:37:59 +08009395 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009396
9397 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9398
9399 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009400}
9401
James Ketrenosafbf30a2005-08-25 00:05:33 -05009402static int ipw_request_direct_scan(struct ipw_priv *priv, char *essid,
9403 int essid_len)
9404{
9405 struct ipw_scan_request_ext scan;
9406 int err = 0, scan_type;
9407
Pekka Enbergefb34422005-11-16 21:55:05 +02009408 if (!(priv->status & STATUS_INIT) ||
9409 (priv->status & STATUS_EXIT_PENDING))
9410 return 0;
9411
Zhu Yi46441512006-01-24 16:37:59 +08009412 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009413
9414 if (priv->status & STATUS_RF_KILL_MASK) {
9415 IPW_DEBUG_HC("Aborting scan due to RF kill activation\n");
9416 priv->status |= STATUS_SCAN_PENDING;
9417 goto done;
9418 }
9419
9420 IPW_DEBUG_HC("starting request direct scan!\n");
9421
9422 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
Olaf Kirchd834a412006-01-09 17:00:37 +01009423 /* We should not sleep here; otherwise we will block most
9424 * of the system (for instance, we hold rtnl_lock when we
9425 * get here).
9426 */
9427 err = -EAGAIN;
9428 goto done;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009429 }
9430 memset(&scan, 0, sizeof(scan));
9431
9432 if (priv->config & CFG_SPEED_SCAN)
9433 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9434 cpu_to_le16(30);
9435 else
9436 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9437 cpu_to_le16(20);
9438
9439 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
9440 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05009441 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009442 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
9443
9444 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
9445
9446 err = ipw_send_ssid(priv, essid, essid_len);
9447 if (err) {
9448 IPW_DEBUG_HC("Attempt to send SSID command failed\n");
9449 goto done;
9450 }
9451 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
9452
9453 ipw_add_scan_channels(priv, &scan, scan_type);
9454
9455 err = ipw_send_scan_request_ext(priv, &scan);
9456 if (err) {
9457 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
9458 goto done;
9459 }
9460
9461 priv->status |= STATUS_SCANNING;
9462
9463 done:
Zhu Yi46441512006-01-24 16:37:59 +08009464 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009465 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009466}
9467
Jeff Garzikbf794512005-07-31 13:07:26 -04009468static int ipw_wx_set_scan(struct net_device *dev,
9469 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009470 union iwreq_data *wrqu, char *extra)
9471{
9472 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009473 struct iw_scan_req *req = (struct iw_scan_req *)extra;
9474
9475 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009476 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
9477 ipw_request_direct_scan(priv, req->essid,
9478 req->essid_len);
9479 return 0;
9480 }
Zhu Yi094c4d22006-08-21 11:39:03 +08009481 if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9482 queue_work(priv->workqueue,
9483 &priv->request_passive_scan);
9484 return 0;
9485 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05009486 }
James Ketrenos8935f392005-10-05 15:59:08 -05009487
James Ketrenos43f66a62005-03-25 12:31:53 -06009488 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009489
David Howellsc4028952006-11-22 14:57:56 +00009490 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05009491
James Ketrenos43f66a62005-03-25 12:31:53 -06009492 return 0;
9493}
9494
Jeff Garzikbf794512005-07-31 13:07:26 -04009495static int ipw_wx_get_scan(struct net_device *dev,
9496 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009497 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009498{
James Ketrenos43f66a62005-03-25 12:31:53 -06009499 struct ipw_priv *priv = ieee80211_priv(dev);
9500 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9501}
9502
Jeff Garzikbf794512005-07-31 13:07:26 -04009503static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009504 struct iw_request_info *info,
9505 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009506{
9507 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009508 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009509 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009510
Zhu Yi46441512006-01-24 16:37:59 +08009511 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009512 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009513
Hong Liucaeff812005-08-05 17:25:50 +08009514 /* In IBSS mode, we need to notify the firmware to update
9515 * the beacon info after we changed the capability. */
9516 if (cap != priv->capability &&
9517 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9518 priv->status & STATUS_ASSOCIATED)
9519 ipw_disassociate(priv);
9520
Zhu Yi46441512006-01-24 16:37:59 +08009521 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009522 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009523}
9524
Jeff Garzikbf794512005-07-31 13:07:26 -04009525static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009526 struct iw_request_info *info,
9527 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009528{
9529 struct ipw_priv *priv = ieee80211_priv(dev);
9530 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9531}
9532
Jeff Garzikbf794512005-07-31 13:07:26 -04009533static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009534 struct iw_request_info *info,
9535 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009536{
9537 struct ipw_priv *priv = ieee80211_priv(dev);
9538 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009539 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009540 if (wrqu->power.disabled) {
9541 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9542 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9543 if (err) {
9544 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009545 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009546 return err;
9547 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009548 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009549 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009550 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009551 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009552
9553 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009554 case IW_POWER_ON: /* If not specified */
9555 case IW_POWER_MODE: /* If set all mask */
9556 case IW_POWER_ALL_R: /* If explicitely state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009557 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009558 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009559 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9560 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009561 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009562 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009563 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009564
James Ketrenos43f66a62005-03-25 12:31:53 -06009565 /* If the user hasn't specified a power management mode yet, default
9566 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009567 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009568 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009569 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009570 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
9571 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9572 if (err) {
9573 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009574 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009575 return err;
9576 }
9577
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009578 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009579 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009580 return 0;
9581}
9582
Jeff Garzikbf794512005-07-31 13:07:26 -04009583static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009584 struct iw_request_info *info,
9585 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009586{
9587 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009588 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009589 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009590 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009591 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009592 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009593
Zhu Yi46441512006-01-24 16:37:59 +08009594 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009595 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009596
James Ketrenos43f66a62005-03-25 12:31:53 -06009597 return 0;
9598}
9599
Jeff Garzikbf794512005-07-31 13:07:26 -04009600static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009601 struct iw_request_info *info,
9602 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009603{
9604 struct ipw_priv *priv = ieee80211_priv(dev);
9605 int mode = *(int *)extra;
9606 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009607 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009608 if ((mode < 1) || (mode > IPW_POWER_LIMIT)) {
9609 mode = IPW_POWER_AC;
9610 priv->power_mode = mode;
9611 } else {
9612 priv->power_mode = IPW_POWER_ENABLED | mode;
9613 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009614
James Ketrenos43f66a62005-03-25 12:31:53 -06009615 if (priv->power_mode != mode) {
9616 err = ipw_send_power_mode(priv, mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009617
James Ketrenos43f66a62005-03-25 12:31:53 -06009618 if (err) {
9619 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009620 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009621 return err;
9622 }
9623 }
Zhu Yi46441512006-01-24 16:37:59 +08009624 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009625 return 0;
9626}
9627
9628#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009629static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009630 struct iw_request_info *info,
9631 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009632{
9633 struct ipw_priv *priv = ieee80211_priv(dev);
9634 int level = IPW_POWER_LEVEL(priv->power_mode);
9635 char *p = extra;
9636
9637 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9638
9639 switch (level) {
9640 case IPW_POWER_AC:
9641 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9642 break;
9643 case IPW_POWER_BATTERY:
9644 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9645 break;
9646 default:
9647 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009648 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009649 timeout_duration[level - 1] / 1000,
9650 period_duration[level - 1] / 1000);
9651 }
9652
9653 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009654 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009655
9656 wrqu->data.length = p - extra + 1;
9657
9658 return 0;
9659}
9660
9661static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009662 struct iw_request_info *info,
9663 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009664{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009665 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009666 int mode = *(int *)extra;
9667 u8 band = 0, modulation = 0;
9668
9669 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009670 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009671 return -EINVAL;
9672 }
Zhu Yi46441512006-01-24 16:37:59 +08009673 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009674 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009675 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009676 if (mode & IEEE_A) {
9677 band |= IEEE80211_52GHZ_BAND;
9678 modulation |= IEEE80211_OFDM_MODULATION;
9679 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009680 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009681 } else {
9682 if (mode & IEEE_A) {
9683 IPW_WARNING("Attempt to set 2200BG into "
9684 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009685 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009686 return -EINVAL;
9687 }
9688
James Ketrenosa33a1982005-09-14 14:28:59 -05009689 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009690 }
9691
9692 if (mode & IEEE_B) {
9693 band |= IEEE80211_24GHZ_BAND;
9694 modulation |= IEEE80211_CCK_MODULATION;
9695 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009696 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009697
James Ketrenos43f66a62005-03-25 12:31:53 -06009698 if (mode & IEEE_G) {
9699 band |= IEEE80211_24GHZ_BAND;
9700 modulation |= IEEE80211_OFDM_MODULATION;
9701 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009702 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009703
9704 priv->ieee->mode = mode;
9705 priv->ieee->freq_band = band;
9706 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009707 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009708
James Ketrenosc848d0a2005-08-24 21:56:24 -05009709 /* Network configuration changed -- force [re]association */
9710 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9711 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009712 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009713 ipw_associate(priv);
9714 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009715
James Ketrenosa613bff2005-08-24 21:43:11 -05009716 /* Update the band LEDs */
9717 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009718
Jeff Garzikbf794512005-07-31 13:07:26 -04009719 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009720 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009721 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009722 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009723 return 0;
9724}
9725
9726static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009727 struct iw_request_info *info,
9728 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009729{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009730 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009731 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009732 switch (priv->ieee->mode) {
9733 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009734 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9735 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009736 case IEEE_B:
9737 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9738 break;
9739 case IEEE_A | IEEE_B:
9740 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9741 break;
9742 case IEEE_G:
9743 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9744 break;
9745 case IEEE_A | IEEE_G:
9746 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9747 break;
9748 case IEEE_B | IEEE_G:
9749 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9750 break;
9751 case IEEE_A | IEEE_B | IEEE_G:
9752 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9753 break;
9754 default:
9755 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009756 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009757 }
9758
James Ketrenos43f66a62005-03-25 12:31:53 -06009759 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9760
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009761 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009762 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009763
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009764 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009765}
9766
James Ketrenosea2b26e2005-08-24 21:25:16 -05009767static int ipw_wx_set_preamble(struct net_device *dev,
9768 struct iw_request_info *info,
9769 union iwreq_data *wrqu, char *extra)
9770{
9771 struct ipw_priv *priv = ieee80211_priv(dev);
9772 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009773 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009774 /* Switching from SHORT -> LONG requires a disassociation */
9775 if (mode == 1) {
9776 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9777 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009778
9779 /* Network configuration changed -- force [re]association */
9780 IPW_DEBUG_ASSOC
9781 ("[re]association triggered due to preamble change.\n");
9782 if (!ipw_disassociate(priv))
9783 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009784 }
9785 goto done;
9786 }
9787
9788 if (mode == 0) {
9789 priv->config &= ~CFG_PREAMBLE_LONG;
9790 goto done;
9791 }
Zhu Yi46441512006-01-24 16:37:59 +08009792 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009793 return -EINVAL;
9794
9795 done:
Zhu Yi46441512006-01-24 16:37:59 +08009796 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009797 return 0;
9798}
9799
9800static int ipw_wx_get_preamble(struct net_device *dev,
9801 struct iw_request_info *info,
9802 union iwreq_data *wrqu, char *extra)
9803{
9804 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009805 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009806 if (priv->config & CFG_PREAMBLE_LONG)
9807 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9808 else
9809 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009810 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009811 return 0;
9812}
9813
James Ketrenosb095c382005-08-24 22:04:42 -05009814#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009815static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009816 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009817 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009818{
James Ketrenos43f66a62005-03-25 12:31:53 -06009819 struct ipw_priv *priv = ieee80211_priv(dev);
9820 int *parms = (int *)extra;
9821 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009822 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009823 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009824 if (enable) {
9825 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009826#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009827 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9828#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009829 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009830#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009831 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009832 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009833
James Ketrenos43f66a62005-03-25 12:31:53 -06009834 ipw_set_channel(priv, parms[1]);
9835 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009836 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009837 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009838 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009839 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009840 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009841 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009842 }
Zhu Yi46441512006-01-24 16:37:59 +08009843 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009844 return 0;
9845}
9846
Pavel Machek67fd6b42006-07-11 15:34:05 +02009847#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009848
Jeff Garzikbf794512005-07-31 13:07:26 -04009849static int ipw_wx_reset(struct net_device *dev,
9850 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009851 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009852{
James Ketrenos43f66a62005-03-25 12:31:53 -06009853 struct ipw_priv *priv = ieee80211_priv(dev);
9854 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009855 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009856 return 0;
9857}
James Ketrenosb095c382005-08-24 22:04:42 -05009858
James Ketrenosb095c382005-08-24 22:04:42 -05009859static int ipw_wx_sw_reset(struct net_device *dev,
9860 struct iw_request_info *info,
9861 union iwreq_data *wrqu, char *extra)
9862{
9863 struct ipw_priv *priv = ieee80211_priv(dev);
9864 union iwreq_data wrqu_sec = {
9865 .encoding = {
9866 .flags = IW_ENCODE_DISABLED,
9867 },
9868 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009869 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009870
9871 IPW_DEBUG_WX("SW_RESET\n");
9872
Zhu Yi46441512006-01-24 16:37:59 +08009873 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009874
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009875 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009876 if (!ret) {
9877 free_firmware();
9878 ipw_adapter_restart(priv);
9879 }
James Ketrenosb095c382005-08-24 22:04:42 -05009880
9881 /* The SW reset bit might have been toggled on by the 'disable'
9882 * module parameter, so take appropriate action */
9883 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9884
Zhu Yi46441512006-01-24 16:37:59 +08009885 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009886 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009887 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009888
9889 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9890 /* Configuration likely changed -- force [re]association */
9891 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9892 "reset.\n");
9893 if (!ipw_disassociate(priv))
9894 ipw_associate(priv);
9895 }
9896
Zhu Yi46441512006-01-24 16:37:59 +08009897 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009898
9899 return 0;
9900}
James Ketrenos43f66a62005-03-25 12:31:53 -06009901
9902/* Rebase the WE IOCTLs to zero for the handler array */
9903#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009904static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009905 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9906 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9907 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9908 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9909 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009910 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9911 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009912 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9913 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9914 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9915 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9916 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9917 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9918 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9919 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9920 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9921 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9922 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9923 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9924 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9925 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9926 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9927 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9928 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9929 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9930 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9931 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9932 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9933 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9934 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009935 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9936 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9937 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9938 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009939 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9940 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
9941 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
9942 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
9943 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
9944 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
9945 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -06009946};
9947
James Ketrenosb095c382005-08-24 22:04:42 -05009948enum {
9949 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
9950 IPW_PRIV_GET_POWER,
9951 IPW_PRIV_SET_MODE,
9952 IPW_PRIV_GET_MODE,
9953 IPW_PRIV_SET_PREAMBLE,
9954 IPW_PRIV_GET_PREAMBLE,
9955 IPW_PRIV_RESET,
9956 IPW_PRIV_SW_RESET,
9957#ifdef CONFIG_IPW2200_MONITOR
9958 IPW_PRIV_SET_MONITOR,
9959#endif
9960};
James Ketrenos43f66a62005-03-25 12:31:53 -06009961
Jeff Garzikbf794512005-07-31 13:07:26 -04009962static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -06009963 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009964 .cmd = IPW_PRIV_SET_POWER,
9965 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9966 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009967 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009968 .cmd = IPW_PRIV_GET_POWER,
9969 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9970 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009971 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009972 .cmd = IPW_PRIV_SET_MODE,
9973 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9974 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009975 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009976 .cmd = IPW_PRIV_GET_MODE,
9977 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9978 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009979 {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009980 .cmd = IPW_PRIV_SET_PREAMBLE,
9981 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9982 .name = "set_preamble"},
9983 {
9984 .cmd = IPW_PRIV_GET_PREAMBLE,
9985 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
9986 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009987 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009988 IPW_PRIV_RESET,
9989 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -05009990 {
9991 IPW_PRIV_SW_RESET,
9992 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
9993#ifdef CONFIG_IPW2200_MONITOR
9994 {
9995 IPW_PRIV_SET_MONITOR,
9996 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
9997#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -06009998};
9999
10000static iw_handler ipw_priv_handler[] = {
10001 ipw_wx_set_powermode,
10002 ipw_wx_get_powermode,
10003 ipw_wx_set_wireless_mode,
10004 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -050010005 ipw_wx_set_preamble,
10006 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -040010007 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -050010008 ipw_wx_sw_reset,
10009#ifdef CONFIG_IPW2200_MONITOR
10010 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -060010011#endif
10012};
10013
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010014static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010015 .standard = ipw_wx_handlers,
10016 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
10017 .num_private = ARRAY_SIZE(ipw_priv_handler),
10018 .num_private_args = ARRAY_SIZE(ipw_priv_args),
10019 .private = ipw_priv_handler,
10020 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000010021 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -060010022};
10023
James Ketrenos43f66a62005-03-25 12:31:53 -060010024/*
10025 * Get wireless statistics.
10026 * Called by /proc/net/wireless
10027 * Also called by SIOCGIWSTATS
10028 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010029static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -060010030{
10031 struct ipw_priv *priv = ieee80211_priv(dev);
10032 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010033
James Ketrenos43f66a62005-03-25 12:31:53 -060010034 wstats = &priv->wstats;
10035
James Ketrenosea2b26e2005-08-24 21:25:16 -050010036 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -050010037 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -060010038 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
10039 * and associated; if not associcated, the values are all meaningless
10040 * anyway, so set them all to NULL and INVALID */
10041 if (!(priv->status & STATUS_ASSOCIATED)) {
10042 wstats->miss.beacon = 0;
10043 wstats->discard.retries = 0;
10044 wstats->qual.qual = 0;
10045 wstats->qual.level = 0;
10046 wstats->qual.noise = 0;
10047 wstats->qual.updated = 7;
10048 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010049 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -060010050 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010051 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010052
10053 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +080010054 wstats->qual.level = priv->exp_avg_rssi;
10055 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -060010056 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +080010057 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010058
10059 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
10060 wstats->discard.retries = priv->last_tx_failures;
10061 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -040010062
James Ketrenos43f66a62005-03-25 12:31:53 -060010063/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
10064 goto fail_get_ordinal;
10065 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -040010066
James Ketrenos43f66a62005-03-25 12:31:53 -060010067 return wstats;
10068}
10069
James Ketrenos43f66a62005-03-25 12:31:53 -060010070/* net device stuff */
10071
Arjan van de Ven858119e2006-01-14 13:20:43 -080010072static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -060010073{
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010074 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +080010075 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010076 sys_config->answer_broadcast_ssid_probe = 0;
10077 sys_config->accept_all_data_frames = 0;
10078 sys_config->accept_non_directed_frames = 1;
10079 sys_config->exclude_unicast_unencrypted = 0;
10080 sys_config->disable_unicast_decryption = 1;
10081 sys_config->exclude_multicast_unencrypted = 0;
10082 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010083 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10084 antenna = CFG_SYS_ANTENNA_BOTH;
10085 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010086 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010087 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010088 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010089 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010090 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010091 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010092}
10093
10094static int ipw_net_open(struct net_device *dev)
10095{
10096 struct ipw_priv *priv = ieee80211_priv(dev);
10097 IPW_DEBUG_INFO("dev->open\n");
10098 /* we should be verifying the device is ready to be opened */
Zhu Yi46441512006-01-24 16:37:59 +080010099 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -040010100 if (!(priv->status & STATUS_RF_KILL_MASK) &&
10101 (priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -060010102 netif_start_queue(dev);
Zhu Yi46441512006-01-24 16:37:59 +080010103 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010104 return 0;
10105}
10106
10107static int ipw_net_stop(struct net_device *dev)
10108{
10109 IPW_DEBUG_INFO("dev->close\n");
10110 netif_stop_queue(dev);
10111 return 0;
10112}
10113
10114/*
10115todo:
10116
10117modify to send one tfd per fragment instead of using chunking. otherwise
10118we need to heavily modify the ieee80211_skb_to_txb.
10119*/
10120
Arjan van de Ven858119e2006-01-14 13:20:43 -080010121static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010122 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010123{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010124 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010125 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010126 int i = 0;
10127 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010128#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010129 int tx_id = ipw_get_tx_queue_number(priv, pri);
10130 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10131#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010132 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010133#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010134 struct clx2_queue *q = &txq->q;
10135 u8 id, hdr_len, unicast;
10136 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010137 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010138
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010139 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010140 switch (priv->ieee->iw_mode) {
10141 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010142 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010143 id = ipw_find_station(priv, hdr->addr1);
10144 if (id == IPW_INVALID_STATION) {
10145 id = ipw_add_station(priv, hdr->addr1);
10146 if (id == IPW_INVALID_STATION) {
10147 IPW_WARNING("Attempt to send data to "
Jeff Garzikbf794512005-07-31 13:07:26 -040010148 "invalid cell: " MAC_FMT "\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010149 MAC_ARG(hdr->addr1));
10150 goto drop;
10151 }
10152 }
10153 break;
10154
10155 case IW_MODE_INFRA:
10156 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010157 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010158 id = 0;
10159 break;
10160 }
10161
10162 tfd = &txq->bd[q->first_empty];
10163 txq->txb[q->first_empty] = txb;
10164 memset(tfd, 0, sizeof(*tfd));
10165 tfd->u.data.station_number = id;
10166
10167 tfd->control_flags.message_type = TX_FRAME_TYPE;
10168 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10169
10170 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010171 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010172 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010173
James Ketrenos43f66a62005-03-25 12:31:53 -060010174 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010175 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010176 else
James Ketrenosb095c382005-08-24 22:04:42 -050010177 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010178
James Ketrenosea2b26e2005-08-24 21:25:16 -050010179 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10180 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010181
James Ketrenosc848d0a2005-08-24 21:56:24 -050010182 fc = le16_to_cpu(hdr->frame_ctl);
10183 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010184
10185 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10186
James Ketrenosb095c382005-08-24 22:04:42 -050010187 if (likely(unicast))
10188 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10189
10190 if (txb->encrypted && !priv->ieee->host_encrypt) {
10191 switch (priv->ieee->sec.level) {
10192 case SEC_LEVEL_3:
10193 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010194 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010195 /* XXX: ACK flag must be set for CCMP even if it
10196 * is a multicast/broadcast packet, because CCMP
10197 * group communication encrypted by GTK is
10198 * actually done by the AP. */
10199 if (!unicast)
10200 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10201
10202 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10203 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10204 tfd->u.data.key_index = 0;
10205 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10206 break;
10207 case SEC_LEVEL_2:
10208 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010209 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010210 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10211 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10212 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10213 break;
10214 case SEC_LEVEL_1:
10215 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010216 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010217 tfd->u.data.key_index = priv->ieee->tx_keyidx;
10218 if (priv->ieee->sec.key_sizes[priv->ieee->tx_keyidx] <=
10219 40)
10220 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10221 else
10222 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10223 break;
10224 case SEC_LEVEL_0:
10225 break;
10226 default:
10227 printk(KERN_ERR "Unknow security level %d\n",
10228 priv->ieee->sec.level);
10229 break;
10230 }
10231 } else
10232 /* No hardware encryption */
10233 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10234
Zhu Yie43e3c12006-04-13 17:20:45 +080010235#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010236 if (fc & IEEE80211_STYPE_QOS_DATA)
10237 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010238#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010239
James Ketrenos43f66a62005-03-25 12:31:53 -060010240 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010241 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10242 txb->nr_frags));
10243 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10244 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10245 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10246 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10247 i, le32_to_cpu(tfd->u.data.num_chunks),
10248 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010249 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010250 i, tfd->u.data.num_chunks,
10251 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010252 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010253 txb->fragments[i]->len - hdr_len);
10254
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010255 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010256 cpu_to_le32(pci_map_single
10257 (priv->pci_dev,
10258 txb->fragments[i]->data + hdr_len,
10259 txb->fragments[i]->len - hdr_len,
10260 PCI_DMA_TODEVICE));
10261 tfd->u.data.chunk_len[i] =
10262 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010263 }
10264
10265 if (i != txb->nr_frags) {
10266 struct sk_buff *skb;
10267 u16 remaining_bytes = 0;
10268 int j;
10269
10270 for (j = i; j < txb->nr_frags; j++)
10271 remaining_bytes += txb->fragments[j]->len - hdr_len;
10272
10273 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10274 remaining_bytes);
10275 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10276 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010277 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010278 for (j = i; j < txb->nr_frags; j++) {
10279 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010280
James Ketrenos43f66a62005-03-25 12:31:53 -060010281 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010282 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010283 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010284 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010285 }
10286 dev_kfree_skb_any(txb->fragments[i]);
10287 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010288 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010289 cpu_to_le32(pci_map_single
10290 (priv->pci_dev, skb->data,
10291 tfd->u.data.chunk_len[i],
10292 PCI_DMA_TODEVICE));
10293
10294 tfd->u.data.num_chunks =
10295 cpu_to_le32(le32_to_cpu(tfd->u.data.num_chunks) +
10296 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010297 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010298 }
10299
10300 /* kick DMA */
10301 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10302 ipw_write32(priv, q->reg_w, q->first_empty);
10303
James Ketrenosf6970142006-02-14 09:10:51 +080010304 if (ipw_queue_space(q) < q->high_mark)
10305 netif_stop_queue(priv->net_dev);
10306
James Ketrenos227d2dc2005-07-28 16:25:55 -050010307 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010308
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010309 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010310 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10311 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010312 return NETDEV_TX_OK;
10313}
10314
10315static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10316{
10317 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010318#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010319 int tx_id = ipw_get_tx_queue_number(priv, pri);
10320 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10321#else
10322 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010323#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010324
10325 if (ipw_queue_space(&txq->q) < txq->q.high_mark)
10326 return 1;
10327
10328 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010329}
10330
Zhu Yid685b8c2006-04-13 17:20:27 +080010331#ifdef CONFIG_IPW2200_PROMISCUOUS
10332static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10333 struct ieee80211_txb *txb)
10334{
10335 struct ieee80211_rx_stats dummystats;
10336 struct ieee80211_hdr *hdr;
10337 u8 n;
10338 u16 filter = priv->prom_priv->filter;
10339 int hdr_only = 0;
10340
10341 if (filter & IPW_PROM_NO_TX)
10342 return;
10343
10344 memset(&dummystats, 0, sizeof(dummystats));
10345
10346 /* Filtering of fragment chains is done agains the first fragment */
10347 hdr = (void *)txb->fragments[0]->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010348 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010349 if (filter & IPW_PROM_NO_MGMT)
10350 return;
10351 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10352 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010353 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010354 if (filter & IPW_PROM_NO_CTL)
10355 return;
10356 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10357 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010358 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010359 if (filter & IPW_PROM_NO_DATA)
10360 return;
10361 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10362 hdr_only = 1;
10363 }
10364
10365 for(n=0; n<txb->nr_frags; ++n) {
10366 struct sk_buff *src = txb->fragments[n];
10367 struct sk_buff *dst;
10368 struct ieee80211_radiotap_header *rt_hdr;
10369 int len;
10370
10371 if (hdr_only) {
10372 hdr = (void *)src->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010373 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +080010374 } else
10375 len = src->len;
10376
10377 dst = alloc_skb(
10378 len + IEEE80211_RADIOTAP_HDRLEN, GFP_ATOMIC);
10379 if (!dst) continue;
10380
10381 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10382
10383 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10384 rt_hdr->it_pad = 0;
10385 rt_hdr->it_present = 0; /* after all, it's just an idea */
10386 rt_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL);
10387
10388 *(u16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
10389 ieee80211chan2mhz(priv->channel));
10390 if (priv->channel > 14) /* 802.11a */
10391 *(u16*)skb_put(dst, sizeof(u16)) =
10392 cpu_to_le16(IEEE80211_CHAN_OFDM |
10393 IEEE80211_CHAN_5GHZ);
10394 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
10395 *(u16*)skb_put(dst, sizeof(u16)) =
10396 cpu_to_le16(IEEE80211_CHAN_CCK |
10397 IEEE80211_CHAN_2GHZ);
10398 else /* 802.11g */
10399 *(u16*)skb_put(dst, sizeof(u16)) =
10400 cpu_to_le16(IEEE80211_CHAN_OFDM |
10401 IEEE80211_CHAN_2GHZ);
10402
10403 rt_hdr->it_len = dst->len;
10404
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -030010405 skb_copy_from_linear_data(src, skb_put(dst, len), len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010406
10407 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10408 dev_kfree_skb_any(dst);
10409 }
10410}
10411#endif
10412
James Ketrenos43f66a62005-03-25 12:31:53 -060010413static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010414 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010415{
10416 struct ipw_priv *priv = ieee80211_priv(dev);
10417 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010418 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010419
10420 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010421 spin_lock_irqsave(&priv->lock, flags);
10422
10423 if (!(priv->status & STATUS_ASSOCIATED)) {
10424 IPW_DEBUG_INFO("Tx attempt while not associated.\n");
10425 priv->ieee->stats.tx_carrier_errors++;
10426 netif_stop_queue(dev);
10427 goto fail_unlock;
10428 }
10429
Zhu Yid685b8c2006-04-13 17:20:27 +080010430#ifdef CONFIG_IPW2200_PROMISCUOUS
10431 if (rtap_iface && netif_running(priv->prom_net_dev))
10432 ipw_handle_promiscuous_tx(priv, txb);
10433#endif
10434
James Ketrenos227d2dc2005-07-28 16:25:55 -050010435 ret = ipw_tx_skb(priv, txb, pri);
10436 if (ret == NETDEV_TX_OK)
10437 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010438 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010439
James Ketrenos227d2dc2005-07-28 16:25:55 -050010440 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010441
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010442 fail_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010443 spin_unlock_irqrestore(&priv->lock, flags);
10444 return 1;
10445}
10446
10447static struct net_device_stats *ipw_net_get_stats(struct net_device *dev)
10448{
10449 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzikbf794512005-07-31 13:07:26 -040010450
James Ketrenos43f66a62005-03-25 12:31:53 -060010451 priv->ieee->stats.tx_packets = priv->tx_packets;
10452 priv->ieee->stats.rx_packets = priv->rx_packets;
10453 return &priv->ieee->stats;
10454}
10455
10456static void ipw_net_set_multicast_list(struct net_device *dev)
10457{
10458
10459}
10460
10461static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10462{
10463 struct ipw_priv *priv = ieee80211_priv(dev);
10464 struct sockaddr *addr = p;
10465 if (!is_valid_ether_addr(addr->sa_data))
10466 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010467 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010468 priv->config |= CFG_CUSTOM_MAC;
10469 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
10470 printk(KERN_INFO "%s: Setting MAC to " MAC_FMT "\n",
10471 priv->net_dev->name, MAC_ARG(priv->mac_addr));
James Ketrenosa613bff2005-08-24 21:43:11 -050010472 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010473 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010474 return 0;
10475}
10476
Jeff Garzikbf794512005-07-31 13:07:26 -040010477static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010478 struct ethtool_drvinfo *info)
10479{
10480 struct ipw_priv *p = ieee80211_priv(dev);
10481 char vers[64];
10482 char date[32];
10483 u32 len;
10484
10485 strcpy(info->driver, DRV_NAME);
10486 strcpy(info->version, DRV_VERSION);
10487
10488 len = sizeof(vers);
10489 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10490 len = sizeof(date);
10491 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10492
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010493 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010494 vers, date);
10495 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010496 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010497}
10498
10499static u32 ipw_ethtool_get_link(struct net_device *dev)
10500{
10501 struct ipw_priv *priv = ieee80211_priv(dev);
10502 return (priv->status & STATUS_ASSOCIATED) != 0;
10503}
10504
10505static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10506{
James Ketrenosb095c382005-08-24 22:04:42 -050010507 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010508}
10509
10510static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010511 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010512{
10513 struct ipw_priv *p = ieee80211_priv(dev);
10514
James Ketrenosb095c382005-08-24 22:04:42 -050010515 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010516 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010517 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010518 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010519 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010520 return 0;
10521}
10522
10523static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010524 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010525{
10526 struct ipw_priv *p = ieee80211_priv(dev);
10527 int i;
10528
James Ketrenosb095c382005-08-24 22:04:42 -050010529 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010530 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010531 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010532 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010533 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10534 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010535 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010536 return 0;
10537}
10538
Jeff Garzik7282d492006-09-13 14:30:00 -040010539static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010540 .get_link = ipw_ethtool_get_link,
10541 .get_drvinfo = ipw_ethtool_get_drvinfo,
10542 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10543 .get_eeprom = ipw_ethtool_get_eeprom,
10544 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010545};
10546
David Howells7d12e782006-10-05 14:55:46 +010010547static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010548{
10549 struct ipw_priv *priv = data;
10550 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010551
James Ketrenos43f66a62005-03-25 12:31:53 -060010552 if (!priv)
10553 return IRQ_NONE;
10554
Zhu Yi89c318e2006-06-08 22:19:49 -070010555 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010556
10557 if (!(priv->status & STATUS_INT_ENABLED)) {
10558 /* Shared IRQ */
10559 goto none;
10560 }
10561
James Ketrenosb095c382005-08-24 22:04:42 -050010562 inta = ipw_read32(priv, IPW_INTA_RW);
10563 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010564
James Ketrenos43f66a62005-03-25 12:31:53 -060010565 if (inta == 0xFFFFFFFF) {
10566 /* Hardware disappeared */
10567 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10568 goto none;
10569 }
10570
James Ketrenosb095c382005-08-24 22:04:42 -050010571 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010572 /* Shared interrupt */
10573 goto none;
10574 }
10575
10576 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010577 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010578
James Ketrenos43f66a62005-03-25 12:31:53 -060010579 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010580 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10581 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010582
James Ketrenos43f66a62005-03-25 12:31:53 -060010583 /* Cache INTA value for our tasklet */
10584 priv->isr_inta = inta;
10585
10586 tasklet_schedule(&priv->irq_tasklet);
10587
Zhu Yi89c318e2006-06-08 22:19:49 -070010588 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010589
10590 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010591 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010592 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010593 return IRQ_NONE;
10594}
10595
10596static void ipw_rf_kill(void *adapter)
10597{
10598 struct ipw_priv *priv = adapter;
10599 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010600
James Ketrenos43f66a62005-03-25 12:31:53 -060010601 spin_lock_irqsave(&priv->lock, flags);
10602
10603 if (rf_kill_active(priv)) {
10604 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10605 if (priv->workqueue)
10606 queue_delayed_work(priv->workqueue,
10607 &priv->rf_kill, 2 * HZ);
10608 goto exit_unlock;
10609 }
10610
10611 /* RF Kill is now disabled, so bring the device back up */
10612
10613 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10614 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10615 "device\n");
10616
10617 /* we can not do an adapter restart while inside an irq lock */
10618 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010619 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010620 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10621 "enabled\n");
10622
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010623 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010624 spin_unlock_irqrestore(&priv->lock, flags);
10625}
10626
David Howellsc4028952006-11-22 14:57:56 +000010627static void ipw_bg_rf_kill(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010628{
David Howellsc4028952006-11-22 14:57:56 +000010629 struct ipw_priv *priv =
10630 container_of(work, struct ipw_priv, rf_kill.work);
Zhu Yi46441512006-01-24 16:37:59 +080010631 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010632 ipw_rf_kill(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010633 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010634}
10635
Adrian Bunka73e22b2006-01-21 01:39:42 +010010636static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010637{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010638 priv->last_seq_num = -1;
10639 priv->last_frag_num = -1;
10640 priv->last_packet_time = 0;
10641
James Ketrenosa613bff2005-08-24 21:43:11 -050010642 netif_carrier_on(priv->net_dev);
10643 if (netif_queue_stopped(priv->net_dev)) {
10644 IPW_DEBUG_NOTIF("waking queue\n");
10645 netif_wake_queue(priv->net_dev);
10646 } else {
10647 IPW_DEBUG_NOTIF("starting queue\n");
10648 netif_start_queue(priv->net_dev);
10649 }
10650
James Ketrenosc848d0a2005-08-24 21:56:24 -050010651 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -050010652 ipw_reset_stats(priv);
10653 /* Ensure the rate is updated immediately */
10654 priv->last_rate = ipw_get_current_rate(priv);
10655 ipw_gather_stats(priv);
10656 ipw_led_link_up(priv);
10657 notify_wx_assoc_event(priv);
10658
10659 if (priv->config & CFG_BACKGROUND_SCAN)
10660 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10661}
10662
David Howellsc4028952006-11-22 14:57:56 +000010663static void ipw_bg_link_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010664{
David Howellsc4028952006-11-22 14:57:56 +000010665 struct ipw_priv *priv =
10666 container_of(work, struct ipw_priv, link_up);
Zhu Yi46441512006-01-24 16:37:59 +080010667 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010668 ipw_link_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010669 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010670}
10671
Adrian Bunka73e22b2006-01-21 01:39:42 +010010672static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010673{
10674 ipw_led_link_down(priv);
10675 netif_carrier_off(priv->net_dev);
10676 netif_stop_queue(priv->net_dev);
10677 notify_wx_assoc_event(priv);
10678
10679 /* Cancel any queued work ... */
10680 cancel_delayed_work(&priv->request_scan);
10681 cancel_delayed_work(&priv->adhoc_check);
10682 cancel_delayed_work(&priv->gather_stats);
10683
10684 ipw_reset_stats(priv);
10685
James Ketrenosafbf30a2005-08-25 00:05:33 -050010686 if (!(priv->status & STATUS_EXIT_PENDING)) {
10687 /* Queue up another scan... */
David Howellsc4028952006-11-22 14:57:56 +000010688 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010689 }
James Ketrenosa613bff2005-08-24 21:43:11 -050010690}
10691
David Howellsc4028952006-11-22 14:57:56 +000010692static void ipw_bg_link_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010693{
David Howellsc4028952006-11-22 14:57:56 +000010694 struct ipw_priv *priv =
10695 container_of(work, struct ipw_priv, link_down);
Zhu Yi46441512006-01-24 16:37:59 +080010696 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010697 ipw_link_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010698 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010699}
10700
James Ketrenos43f66a62005-03-25 12:31:53 -060010701static int ipw_setup_deferred_work(struct ipw_priv *priv)
10702{
10703 int ret = 0;
10704
James Ketrenos43f66a62005-03-25 12:31:53 -060010705 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010706 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010707 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010708
David Howellsc4028952006-11-22 14:57:56 +000010709 INIT_DELAYED_WORK(&priv->adhoc_check, ipw_bg_adhoc_check);
10710 INIT_WORK(&priv->associate, ipw_bg_associate);
10711 INIT_WORK(&priv->disassociate, ipw_bg_disassociate);
10712 INIT_WORK(&priv->system_config, ipw_system_config);
10713 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish);
10714 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart);
10715 INIT_DELAYED_WORK(&priv->rf_kill, ipw_bg_rf_kill);
10716 INIT_WORK(&priv->up, ipw_bg_up);
10717 INIT_WORK(&priv->down, ipw_bg_down);
10718 INIT_DELAYED_WORK(&priv->request_scan, ipw_request_scan);
10719 INIT_WORK(&priv->request_passive_scan, ipw_request_passive_scan);
10720 INIT_DELAYED_WORK(&priv->gather_stats, ipw_bg_gather_stats);
10721 INIT_WORK(&priv->abort_scan, ipw_bg_abort_scan);
10722 INIT_WORK(&priv->roam, ipw_bg_roam);
10723 INIT_DELAYED_WORK(&priv->scan_check, ipw_bg_scan_check);
10724 INIT_WORK(&priv->link_up, ipw_bg_link_up);
10725 INIT_WORK(&priv->link_down, ipw_bg_link_down);
10726 INIT_DELAYED_WORK(&priv->led_link_on, ipw_bg_led_link_on);
10727 INIT_DELAYED_WORK(&priv->led_link_off, ipw_bg_led_link_off);
10728 INIT_DELAYED_WORK(&priv->led_act_off, ipw_bg_led_activity_off);
10729 INIT_WORK(&priv->merge_networks, ipw_merge_adhoc_network);
James Ketrenos43f66a62005-03-25 12:31:53 -060010730
Zhu Yie43e3c12006-04-13 17:20:45 +080010731#ifdef CONFIG_IPW2200_QOS
David Howellsc4028952006-11-22 14:57:56 +000010732 INIT_WORK(&priv->qos_activate, ipw_bg_qos_activate);
Zhu Yie43e3c12006-04-13 17:20:45 +080010733#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010734
10735 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10736 ipw_irq_tasklet, (unsigned long)priv);
10737
10738 return ret;
10739}
10740
James Ketrenos43f66a62005-03-25 12:31:53 -060010741static void shim__set_security(struct net_device *dev,
10742 struct ieee80211_security *sec)
10743{
10744 struct ipw_priv *priv = ieee80211_priv(dev);
10745 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010746 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010747 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010748 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010749 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010750 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010751 priv->ieee->sec.flags &= ~(1 << i);
10752 else {
10753 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010754 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010755 priv->ieee->sec.flags |= (1 << i);
10756 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010757 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010758 } else if (sec->level != SEC_LEVEL_1)
10759 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010760 }
10761
James Ketrenosb095c382005-08-24 22:04:42 -050010762 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010763 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010764 priv->ieee->sec.active_key = sec->active_key;
10765 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010766 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010767 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010768 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010769 } else
10770 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010771
10772 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010773 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10774 priv->ieee->sec.auth_mode = sec->auth_mode;
10775 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010776 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10777 priv->capability |= CAP_SHARED_KEY;
10778 else
10779 priv->capability &= ~CAP_SHARED_KEY;
10780 priv->status |= STATUS_SECURITY_UPDATED;
10781 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010782
James Ketrenosb095c382005-08-24 22:04:42 -050010783 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10784 priv->ieee->sec.flags |= SEC_ENABLED;
10785 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010786 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010787 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010788 priv->capability |= CAP_PRIVACY_ON;
10789 else
10790 priv->capability &= ~CAP_PRIVACY_ON;
10791 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010792
James Ketrenosafbf30a2005-08-25 00:05:33 -050010793 if (sec->flags & SEC_ENCRYPT)
10794 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010795
James Ketrenosb095c382005-08-24 22:04:42 -050010796 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10797 priv->ieee->sec.level = sec->level;
10798 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010799 priv->status |= STATUS_SECURITY_UPDATED;
10800 }
10801
Zhu Yi1fbfea52005-08-05 17:22:56 +080010802 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10803 ipw_set_hwcrypto_keys(priv);
10804
Jeff Garzikbf794512005-07-31 13:07:26 -040010805 /* To match current functionality of ipw2100 (which works well w/
10806 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010807 * privacy capability changes ... */
10808#if 0
10809 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010810 (((priv->assoc_request.capability &
James Ketrenos43f66a62005-03-25 12:31:53 -060010811 WLAN_CAPABILITY_PRIVACY) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010812 (!(priv->assoc_request.capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010813 WLAN_CAPABILITY_PRIVACY) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010814 IPW_DEBUG_ASSOC("Disassociating due to capability "
10815 "change.\n");
10816 ipw_disassociate(priv);
10817 }
10818#endif
10819}
10820
Jeff Garzikbf794512005-07-31 13:07:26 -040010821static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010822 struct ipw_supported_rates *rates)
10823{
10824 /* TODO: Mask out rates based on priv->rates_mask */
10825
10826 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010827 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010828 switch (priv->ieee->freq_band) {
10829 case IEEE80211_52GHZ_BAND:
10830 rates->ieee_mode = IPW_A_MODE;
10831 rates->purpose = IPW_RATE_CAPABILITIES;
10832 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10833 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10834 break;
10835
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010836 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010837 rates->ieee_mode = IPW_G_MODE;
10838 rates->purpose = IPW_RATE_CAPABILITIES;
10839 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10840 IEEE80211_CCK_DEFAULT_RATES_MASK);
10841 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10842 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10843 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10844 }
10845 break;
10846 }
10847
10848 return 0;
10849}
10850
Jeff Garzikbf794512005-07-31 13:07:26 -040010851static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010852{
James Ketrenos43f66a62005-03-25 12:31:53 -060010853 /* This is only called from ipw_up, which resets/reloads the firmware
10854 so, we don't need to first disable the card before we configure
10855 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010856 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010857 goto error;
10858
10859 /* initialize adapter address */
10860 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10861 goto error;
10862
10863 /* set basic system config settings */
10864 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010865
10866 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10867 * Does not support BT priority yet (don't abort or defer our Tx) */
10868 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010869 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010870
10871 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10872 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010873 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010874 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10875 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010876 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010877 }
10878
Zhu Yid685b8c2006-04-13 17:20:27 +080010879#ifdef CONFIG_IPW2200_PROMISCUOUS
10880 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10881 priv->sys_config.accept_all_data_frames = 1;
10882 priv->sys_config.accept_non_directed_frames = 1;
10883 priv->sys_config.accept_all_mgmt_bcpr = 1;
10884 priv->sys_config.accept_all_mgmt_frames = 1;
10885 }
10886#endif
10887
James Ketrenosc848d0a2005-08-24 21:56:24 -050010888 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10889 priv->sys_config.answer_broadcast_ssid_probe = 1;
10890 else
10891 priv->sys_config.answer_broadcast_ssid_probe = 0;
10892
Zhu Yid685b8c2006-04-13 17:20:27 +080010893 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010894 goto error;
10895
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010896 init_supported_rates(priv, &priv->rates);
10897 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010898 goto error;
10899
10900 /* Set request-to-send threshold */
10901 if (priv->rts_threshold) {
10902 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10903 goto error;
10904 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010905#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010906 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10907 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010908#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010909
10910 if (ipw_set_random_seed(priv))
10911 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010912
James Ketrenos43f66a62005-03-25 12:31:53 -060010913 /* final state transition to the RUN state */
10914 if (ipw_send_host_complete(priv))
10915 goto error;
10916
James Ketrenose6666192005-08-12 09:17:04 -050010917 priv->status |= STATUS_INIT;
10918
10919 ipw_led_init(priv);
10920 ipw_led_radio_on(priv);
10921 priv->notif_missed_beacons = 0;
10922
10923 /* Set hardware WEP key if it is configured. */
10924 if ((priv->capability & CAP_PRIVACY_ON) &&
10925 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10926 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10927 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010928
10929 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010930
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010931 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010932 return -EIO;
10933}
10934
James Ketrenos4f36f802005-08-03 20:36:56 -050010935/*
10936 * NOTE:
10937 *
10938 * These tables have been tested in conjunction with the
10939 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
10940 *
10941 * Altering this values, using it on other hardware, or in geographies
10942 * not intended for resale of the above mentioned Intel adapters has
10943 * not been tested.
10944 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080010945 * Remember to update the table in README.ipw2200 when changing this
10946 * table.
10947 *
James Ketrenos4f36f802005-08-03 20:36:56 -050010948 */
10949static const struct ieee80211_geo ipw_geos[] = {
10950 { /* Restricted */
10951 "---",
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 { /* Custom US/Canada */
10960 "ZZF",
10961 .bg_channels = 11,
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}},
10966 .a_channels = 8,
10967 .a = {{5180, 36},
10968 {5200, 40},
10969 {5220, 44},
10970 {5240, 48},
10971 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10972 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10973 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10974 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
10975 },
10976
10977 { /* Rest of World */
10978 "ZZD",
10979 .bg_channels = 13,
10980 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10981 {2427, 4}, {2432, 5}, {2437, 6},
10982 {2442, 7}, {2447, 8}, {2452, 9},
10983 {2457, 10}, {2462, 11}, {2467, 12},
10984 {2472, 13}},
10985 },
10986
10987 { /* Custom USA & Europe & High */
10988 "ZZA",
10989 .bg_channels = 11,
10990 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10991 {2427, 4}, {2432, 5}, {2437, 6},
10992 {2442, 7}, {2447, 8}, {2452, 9},
10993 {2457, 10}, {2462, 11}},
10994 .a_channels = 13,
10995 .a = {{5180, 36},
10996 {5200, 40},
10997 {5220, 44},
10998 {5240, 48},
10999 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11000 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11001 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11002 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11003 {5745, 149},
11004 {5765, 153},
11005 {5785, 157},
11006 {5805, 161},
11007 {5825, 165}},
11008 },
11009
11010 { /* Custom NA & Europe */
11011 "ZZB",
11012 .bg_channels = 11,
11013 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11014 {2427, 4}, {2432, 5}, {2437, 6},
11015 {2442, 7}, {2447, 8}, {2452, 9},
11016 {2457, 10}, {2462, 11}},
11017 .a_channels = 13,
11018 .a = {{5180, 36},
11019 {5200, 40},
11020 {5220, 44},
11021 {5240, 48},
11022 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11023 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11024 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11025 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11026 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11027 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11028 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11029 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11030 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11031 },
11032
11033 { /* Custom Japan */
11034 "ZZC",
11035 .bg_channels = 11,
11036 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11037 {2427, 4}, {2432, 5}, {2437, 6},
11038 {2442, 7}, {2447, 8}, {2452, 9},
11039 {2457, 10}, {2462, 11}},
11040 .a_channels = 4,
11041 .a = {{5170, 34}, {5190, 38},
11042 {5210, 42}, {5230, 46}},
11043 },
11044
11045 { /* Custom */
11046 "ZZM",
11047 .bg_channels = 11,
11048 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11049 {2427, 4}, {2432, 5}, {2437, 6},
11050 {2442, 7}, {2447, 8}, {2452, 9},
11051 {2457, 10}, {2462, 11}},
11052 },
11053
11054 { /* Europe */
11055 "ZZE",
11056 .bg_channels = 13,
11057 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11058 {2427, 4}, {2432, 5}, {2437, 6},
11059 {2442, 7}, {2447, 8}, {2452, 9},
11060 {2457, 10}, {2462, 11}, {2467, 12},
11061 {2472, 13}},
11062 .a_channels = 19,
11063 .a = {{5180, 36},
11064 {5200, 40},
11065 {5220, 44},
11066 {5240, 48},
11067 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11068 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11069 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11070 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11071 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11072 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11073 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11074 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11075 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11076 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11077 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11078 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11079 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11080 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11081 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11082 },
11083
11084 { /* Custom Japan */
11085 "ZZJ",
11086 .bg_channels = 14,
11087 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11088 {2427, 4}, {2432, 5}, {2437, 6},
11089 {2442, 7}, {2447, 8}, {2452, 9},
11090 {2457, 10}, {2462, 11}, {2467, 12},
11091 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11092 .a_channels = 4,
11093 .a = {{5170, 34}, {5190, 38},
11094 {5210, 42}, {5230, 46}},
11095 },
11096
James Ketrenos03520572005-10-19 16:12:31 -050011097 { /* Rest of World */
11098 "ZZR",
11099 .bg_channels = 14,
11100 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11101 {2427, 4}, {2432, 5}, {2437, 6},
11102 {2442, 7}, {2447, 8}, {2452, 9},
11103 {2457, 10}, {2462, 11}, {2467, 12},
11104 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11105 IEEE80211_CH_PASSIVE_ONLY}},
11106 },
11107
James Ketrenos4f36f802005-08-03 20:36:56 -050011108 { /* High Band */
11109 "ZZH",
11110 .bg_channels = 13,
11111 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11112 {2427, 4}, {2432, 5}, {2437, 6},
11113 {2442, 7}, {2447, 8}, {2452, 9},
11114 {2457, 10}, {2462, 11},
11115 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11116 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11117 .a_channels = 4,
11118 .a = {{5745, 149}, {5765, 153},
11119 {5785, 157}, {5805, 161}},
11120 },
11121
11122 { /* Custom Europe */
11123 "ZZG",
11124 .bg_channels = 13,
11125 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11126 {2427, 4}, {2432, 5}, {2437, 6},
11127 {2442, 7}, {2447, 8}, {2452, 9},
11128 {2457, 10}, {2462, 11},
11129 {2467, 12}, {2472, 13}},
11130 .a_channels = 4,
11131 .a = {{5180, 36}, {5200, 40},
11132 {5220, 44}, {5240, 48}},
11133 },
11134
11135 { /* Europe */
11136 "ZZK",
11137 .bg_channels = 13,
11138 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11139 {2427, 4}, {2432, 5}, {2437, 6},
11140 {2442, 7}, {2447, 8}, {2452, 9},
11141 {2457, 10}, {2462, 11},
11142 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11143 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11144 .a_channels = 24,
11145 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11146 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11147 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11148 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11149 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11150 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11151 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11152 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11153 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11154 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11155 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11156 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11157 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11158 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11159 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11160 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11161 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11162 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11163 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11164 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11165 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11166 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11167 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11168 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11169 },
11170
11171 { /* Europe */
11172 "ZZL",
11173 .bg_channels = 11,
11174 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11175 {2427, 4}, {2432, 5}, {2437, 6},
11176 {2442, 7}, {2447, 8}, {2452, 9},
11177 {2457, 10}, {2462, 11}},
11178 .a_channels = 13,
11179 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11180 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11181 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11182 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11183 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11184 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11185 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11186 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11187 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11188 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11189 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11190 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11191 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11192 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011193};
11194
James Ketrenos43f66a62005-03-25 12:31:53 -060011195#define MAX_HW_RESTARTS 5
11196static int ipw_up(struct ipw_priv *priv)
11197{
James Ketrenos4f36f802005-08-03 20:36:56 -050011198 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011199
11200 if (priv->status & STATUS_EXIT_PENDING)
11201 return -EIO;
11202
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011203 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011204 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011205 GFP_KERNEL);
11206 if (priv->cmdlog == NULL) {
11207 IPW_ERROR("Error allocating %d command log entries.\n",
11208 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011209 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011210 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011211 priv->cmdlog_len = cmdlog;
11212 }
11213 }
11214
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011215 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011216 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011217 * Also start the clocks. */
11218 rc = ipw_load(priv);
11219 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011220 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011221 return rc;
11222 }
11223
11224 ipw_init_ordinals(priv);
11225 if (!(priv->config & CFG_CUSTOM_MAC))
11226 eeprom_parse_mac(priv, priv->mac_addr);
11227 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11228
James Ketrenos4f36f802005-08-03 20:36:56 -050011229 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11230 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11231 ipw_geos[j].name, 3))
11232 break;
11233 }
James Ketrenos03520572005-10-19 16:12:31 -050011234 if (j == ARRAY_SIZE(ipw_geos)) {
11235 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11236 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11237 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11238 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011239 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011240 }
Larry Finger1867b112006-02-28 09:48:28 -060011241 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011242 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011243 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011244 }
11245
James Ketrenosb095c382005-08-24 22:04:42 -050011246 if (priv->status & STATUS_RF_KILL_SW) {
11247 IPW_WARNING("Radio disabled by module parameter.\n");
11248 return 0;
11249 } else if (rf_kill_active(priv)) {
11250 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11251 "Kill switch must be turned off for "
11252 "wireless networking to work.\n");
11253 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11254 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011255 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011256 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011257
11258 rc = ipw_config(priv);
11259 if (!rc) {
11260 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011261
James Ketrenose6666192005-08-12 09:17:04 -050011262 /* If configure to try and auto-associate, kick
11263 * off a scan. */
David Howellsc4028952006-11-22 14:57:56 +000011264 queue_delayed_work(priv->workqueue,
11265 &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011266
James Ketrenos43f66a62005-03-25 12:31:53 -060011267 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011268 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011269
James Ketrenosc848d0a2005-08-24 21:56:24 -050011270 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011271 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11272 i, MAX_HW_RESTARTS);
11273
11274 /* We had an error bringing up the hardware, so take it
11275 * all the way back down so we can try again */
11276 ipw_down(priv);
11277 }
11278
Jeff Garzikbf794512005-07-31 13:07:26 -040011279 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011280 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011281 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011282
James Ketrenos43f66a62005-03-25 12:31:53 -060011283 return -EIO;
11284}
11285
David Howellsc4028952006-11-22 14:57:56 +000011286static void ipw_bg_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011287{
David Howellsc4028952006-11-22 14:57:56 +000011288 struct ipw_priv *priv =
11289 container_of(work, struct ipw_priv, up);
Zhu Yi46441512006-01-24 16:37:59 +080011290 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011291 ipw_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011292 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011293}
11294
James Ketrenosb095c382005-08-24 22:04:42 -050011295static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011296{
James Ketrenosb095c382005-08-24 22:04:42 -050011297 int i;
11298
11299 if (priv->status & STATUS_SCANNING) {
11300 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11301 ipw_abort_scan(priv);
11302 }
11303
11304 if (priv->status & STATUS_ASSOCIATED) {
11305 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11306 ipw_disassociate(priv);
11307 }
11308
11309 ipw_led_shutdown(priv);
11310
11311 /* Wait up to 1s for status to change to not scanning and not
11312 * associated (disassociation can take a while for a ful 802.11
11313 * exchange */
11314 for (i = 1000; i && (priv->status &
11315 (STATUS_DISASSOCIATING |
11316 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11317 udelay(10);
11318
11319 if (priv->status & (STATUS_DISASSOCIATING |
11320 STATUS_ASSOCIATED | STATUS_SCANNING))
11321 IPW_DEBUG_INFO("Still associated or scanning...\n");
11322 else
11323 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11324
James Ketrenosc848d0a2005-08-24 21:56:24 -050011325 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011326 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011327
11328 priv->status &= ~STATUS_INIT;
11329}
11330
James Ketrenos43f66a62005-03-25 12:31:53 -060011331static void ipw_down(struct ipw_priv *priv)
11332{
James Ketrenosb095c382005-08-24 22:04:42 -050011333 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11334
11335 priv->status |= STATUS_EXIT_PENDING;
11336
11337 if (ipw_is_init(priv))
11338 ipw_deinit(priv);
11339
11340 /* Wipe out the EXIT_PENDING status bit if we are not actually
11341 * exiting the module */
11342 if (!exit_pending)
11343 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011344
11345 /* tell the device to stop sending interrupts */
11346 ipw_disable_interrupts(priv);
11347
11348 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011349 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011350 netif_carrier_off(priv->net_dev);
11351 netif_stop_queue(priv->net_dev);
11352
11353 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011354
11355 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011356}
11357
David Howellsc4028952006-11-22 14:57:56 +000011358static void ipw_bg_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011359{
David Howellsc4028952006-11-22 14:57:56 +000011360 struct ipw_priv *priv =
11361 container_of(work, struct ipw_priv, down);
Zhu Yi46441512006-01-24 16:37:59 +080011362 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011363 ipw_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011364 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011365}
11366
11367/* Called by register_netdev() */
11368static int ipw_net_init(struct net_device *dev)
11369{
11370 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011371 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011372
James Ketrenosc848d0a2005-08-24 21:56:24 -050011373 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011374 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011375 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011376 }
11377
Zhu Yi46441512006-01-24 16:37:59 +080011378 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011379 return 0;
11380}
11381
11382/* PCI driver stuff */
11383static struct pci_device_id card_ids[] = {
11384 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11385 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11386 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11387 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11388 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11389 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11390 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11391 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11392 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11393 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11394 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11395 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11396 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11397 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11398 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11399 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11400 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11401 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011402 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011403 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011404 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11405 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011406
James Ketrenos43f66a62005-03-25 12:31:53 -060011407 /* required last entry */
11408 {0,}
11409};
11410
11411MODULE_DEVICE_TABLE(pci, card_ids);
11412
11413static struct attribute *ipw_sysfs_entries[] = {
11414 &dev_attr_rf_kill.attr,
11415 &dev_attr_direct_dword.attr,
11416 &dev_attr_indirect_byte.attr,
11417 &dev_attr_indirect_dword.attr,
11418 &dev_attr_mem_gpio_reg.attr,
11419 &dev_attr_command_event_reg.attr,
11420 &dev_attr_nic_type.attr,
11421 &dev_attr_status.attr,
11422 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011423 &dev_attr_error.attr,
11424 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011425 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011426 &dev_attr_eeprom_delay.attr,
11427 &dev_attr_ucode_version.attr,
11428 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011429 &dev_attr_scan_age.attr,
11430 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011431 &dev_attr_speed_scan.attr,
11432 &dev_attr_net_stats.attr,
Zhu Yi375dd242007-02-14 16:04:24 +080011433 &dev_attr_channels.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011434#ifdef CONFIG_IPW2200_PROMISCUOUS
11435 &dev_attr_rtap_iface.attr,
11436 &dev_attr_rtap_filter.attr,
11437#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011438 NULL
11439};
11440
11441static struct attribute_group ipw_attribute_group = {
11442 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011443 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011444};
11445
Zhu Yid685b8c2006-04-13 17:20:27 +080011446#ifdef CONFIG_IPW2200_PROMISCUOUS
11447static int ipw_prom_open(struct net_device *dev)
11448{
11449 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11450 struct ipw_priv *priv = prom_priv->priv;
11451
11452 IPW_DEBUG_INFO("prom dev->open\n");
11453 netif_carrier_off(dev);
11454 netif_stop_queue(dev);
11455
11456 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11457 priv->sys_config.accept_all_data_frames = 1;
11458 priv->sys_config.accept_non_directed_frames = 1;
11459 priv->sys_config.accept_all_mgmt_bcpr = 1;
11460 priv->sys_config.accept_all_mgmt_frames = 1;
11461
11462 ipw_send_system_config(priv);
11463 }
11464
11465 return 0;
11466}
11467
11468static int ipw_prom_stop(struct net_device *dev)
11469{
11470 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11471 struct ipw_priv *priv = prom_priv->priv;
11472
11473 IPW_DEBUG_INFO("prom dev->stop\n");
11474
11475 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11476 priv->sys_config.accept_all_data_frames = 0;
11477 priv->sys_config.accept_non_directed_frames = 0;
11478 priv->sys_config.accept_all_mgmt_bcpr = 0;
11479 priv->sys_config.accept_all_mgmt_frames = 0;
11480
11481 ipw_send_system_config(priv);
11482 }
11483
11484 return 0;
11485}
11486
11487static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11488{
11489 IPW_DEBUG_INFO("prom dev->xmit\n");
11490 netif_stop_queue(dev);
11491 return -EOPNOTSUPP;
11492}
11493
11494static struct net_device_stats *ipw_prom_get_stats(struct net_device *dev)
11495{
11496 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11497 return &prom_priv->ieee->stats;
11498}
11499
11500static int ipw_prom_alloc(struct ipw_priv *priv)
11501{
11502 int rc = 0;
11503
11504 if (priv->prom_net_dev)
11505 return -EPERM;
11506
11507 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11508 if (priv->prom_net_dev == NULL)
11509 return -ENOMEM;
11510
11511 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11512 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11513 priv->prom_priv->priv = priv;
11514
11515 strcpy(priv->prom_net_dev->name, "rtap%d");
11516
11517 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
11518 priv->prom_net_dev->open = ipw_prom_open;
11519 priv->prom_net_dev->stop = ipw_prom_stop;
11520 priv->prom_net_dev->get_stats = ipw_prom_get_stats;
11521 priv->prom_net_dev->hard_start_xmit = ipw_prom_hard_start_xmit;
11522
11523 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
11524
11525 rc = register_netdev(priv->prom_net_dev);
11526 if (rc) {
11527 free_ieee80211(priv->prom_net_dev);
11528 priv->prom_net_dev = NULL;
11529 return rc;
11530 }
11531
11532 return 0;
11533}
11534
11535static void ipw_prom_free(struct ipw_priv *priv)
11536{
11537 if (!priv->prom_net_dev)
11538 return;
11539
11540 unregister_netdev(priv->prom_net_dev);
11541 free_ieee80211(priv->prom_net_dev);
11542
11543 priv->prom_net_dev = NULL;
11544}
11545
11546#endif
11547
11548
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011549static int ipw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011550{
11551 int err = 0;
11552 struct net_device *net_dev;
11553 void __iomem *base;
11554 u32 length, val;
11555 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011556 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011557
11558 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11559 if (net_dev == NULL) {
11560 err = -ENOMEM;
11561 goto out;
11562 }
11563
11564 priv = ieee80211_priv(net_dev);
11565 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011566
James Ketrenos43f66a62005-03-25 12:31:53 -060011567 priv->net_dev = net_dev;
11568 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011569 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011570 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011571 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011572 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11573 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011574
Zhu Yi46441512006-01-24 16:37:59 +080011575 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011576 if (pci_enable_device(pdev)) {
11577 err = -ENODEV;
11578 goto out_free_ieee80211;
11579 }
11580
11581 pci_set_master(pdev);
11582
Tobias Klauser0e08b442005-06-20 14:28:41 -070011583 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011584 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011585 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011586 if (err) {
11587 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11588 goto out_pci_disable_device;
11589 }
11590
11591 pci_set_drvdata(pdev, priv);
11592
11593 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011594 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011595 goto out_pci_disable_device;
11596
Jeff Garzikbf794512005-07-31 13:07:26 -040011597 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011598 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011599 pci_read_config_dword(pdev, 0x40, &val);
11600 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011601 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011602
James Ketrenos43f66a62005-03-25 12:31:53 -060011603 length = pci_resource_len(pdev, 0);
11604 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011605
James Ketrenos43f66a62005-03-25 12:31:53 -060011606 base = ioremap_nocache(pci_resource_start(pdev, 0), length);
11607 if (!base) {
11608 err = -ENODEV;
11609 goto out_pci_release_regions;
11610 }
11611
11612 priv->hw_base = base;
11613 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11614 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11615
11616 err = ipw_setup_deferred_work(priv);
11617 if (err) {
11618 IPW_ERROR("Unable to setup deferred work\n");
11619 goto out_iounmap;
11620 }
11621
James Ketrenosb095c382005-08-24 22:04:42 -050011622 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011623
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011624 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011625 if (err) {
11626 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11627 goto out_destroy_workqueue;
11628 }
11629
11630 SET_MODULE_OWNER(net_dev);
11631 SET_NETDEV_DEV(net_dev, &pdev->dev);
11632
Zhu Yi46441512006-01-24 16:37:59 +080011633 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011634
James Ketrenos43f66a62005-03-25 12:31:53 -060011635 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11636 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011637 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011638
Zhu Yie43e3c12006-04-13 17:20:45 +080011639#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011640 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011641 priv->ieee->handle_probe_response = ipw_handle_beacon;
11642 priv->ieee->handle_beacon = ipw_handle_probe_response;
11643 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011644#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011645
James Ketrenosc848d0a2005-08-24 21:56:24 -050011646 priv->ieee->perfect_rssi = -20;
11647 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011648
11649 net_dev->open = ipw_net_open;
11650 net_dev->stop = ipw_net_stop;
11651 net_dev->init = ipw_net_init;
11652 net_dev->get_stats = ipw_net_get_stats;
11653 net_dev->set_multicast_list = ipw_net_set_multicast_list;
11654 net_dev->set_mac_address = ipw_net_set_mac_address;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011655 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011656 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011657 net_dev->wireless_handlers = &ipw_wx_handler_def;
11658 net_dev->ethtool_ops = &ipw_ethtool_ops;
11659 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011660 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011661 net_dev->mem_start = pci_resource_start(pdev, 0);
11662 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11663
11664 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11665 if (err) {
11666 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011667 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011668 goto out_release_irq;
11669 }
11670
Zhu Yi46441512006-01-24 16:37:59 +080011671 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011672 err = register_netdev(net_dev);
11673 if (err) {
11674 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011675 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011676 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011677
Zhu Yid685b8c2006-04-13 17:20:27 +080011678#ifdef CONFIG_IPW2200_PROMISCUOUS
11679 if (rtap_iface) {
11680 err = ipw_prom_alloc(priv);
11681 if (err) {
11682 IPW_ERROR("Failed to register promiscuous network "
11683 "device (error %d).\n", err);
11684 unregister_netdev(priv->net_dev);
11685 goto out_remove_sysfs;
11686 }
11687 }
11688#endif
11689
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011690 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11691 "channels, %d 802.11a channels)\n",
11692 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11693 priv->ieee->geo.a_channels);
11694
James Ketrenos43f66a62005-03-25 12:31:53 -060011695 return 0;
11696
James Ketrenosa613bff2005-08-24 21:43:11 -050011697 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011698 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011699 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011700 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011701 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011702 destroy_workqueue(priv->workqueue);
11703 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011704 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011705 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011706 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011707 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011708 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011709 pci_disable_device(pdev);
11710 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011711 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011712 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011713 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011714 return err;
11715}
11716
11717static void ipw_pci_remove(struct pci_dev *pdev)
11718{
11719 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011720 struct list_head *p, *q;
11721 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011722
James Ketrenos43f66a62005-03-25 12:31:53 -060011723 if (!priv)
11724 return;
11725
Zhu Yi46441512006-01-24 16:37:59 +080011726 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011727
James Ketrenosafbf30a2005-08-25 00:05:33 -050011728 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011729 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011730 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11731
Zhu Yi46441512006-01-24 16:37:59 +080011732 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011733
11734 unregister_netdev(priv->net_dev);
11735
11736 if (priv->rxq) {
11737 ipw_rx_queue_free(priv, priv->rxq);
11738 priv->rxq = NULL;
11739 }
11740 ipw_tx_queue_free(priv);
11741
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011742 if (priv->cmdlog) {
11743 kfree(priv->cmdlog);
11744 priv->cmdlog = NULL;
11745 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011746 /* ipw_down will ensure that there is no more pending work
11747 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011748 cancel_delayed_work(&priv->adhoc_check);
11749 cancel_delayed_work(&priv->gather_stats);
11750 cancel_delayed_work(&priv->request_scan);
11751 cancel_delayed_work(&priv->rf_kill);
11752 cancel_delayed_work(&priv->scan_check);
11753 destroy_workqueue(priv->workqueue);
11754 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011755
James Ketrenosafbf30a2005-08-25 00:05:33 -050011756 /* Free MAC hash list for ADHOC */
11757 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11758 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011759 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011760 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011761 }
11762 }
11763
Jesper Juhl8f760782006-06-27 02:55:06 -070011764 kfree(priv->error);
11765 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011766
Zhu Yid685b8c2006-04-13 17:20:27 +080011767#ifdef CONFIG_IPW2200_PROMISCUOUS
11768 ipw_prom_free(priv);
11769#endif
11770
James Ketrenos43f66a62005-03-25 12:31:53 -060011771 free_irq(pdev->irq, priv);
11772 iounmap(priv->hw_base);
11773 pci_release_regions(pdev);
11774 pci_disable_device(pdev);
11775 pci_set_drvdata(pdev, NULL);
11776 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011777 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011778}
11779
James Ketrenos43f66a62005-03-25 12:31:53 -060011780#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011781static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011782{
11783 struct ipw_priv *priv = pci_get_drvdata(pdev);
11784 struct net_device *dev = priv->net_dev;
11785
11786 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11787
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011788 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011789 ipw_down(priv);
11790
11791 /* Remove the PRESENT state of the device */
11792 netif_device_detach(dev);
11793
James Ketrenos43f66a62005-03-25 12:31:53 -060011794 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011795 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011796 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011797
James Ketrenos43f66a62005-03-25 12:31:53 -060011798 return 0;
11799}
11800
11801static int ipw_pci_resume(struct pci_dev *pdev)
11802{
11803 struct ipw_priv *priv = pci_get_drvdata(pdev);
11804 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011805 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011806 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011807
James Ketrenos43f66a62005-03-25 12:31:53 -060011808 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11809
James Ketrenosea2b26e2005-08-24 21:25:16 -050011810 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011811 err = pci_enable_device(pdev);
11812 if (err) {
11813 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11814 dev->name);
11815 return err;
11816 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011817 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011818
James Ketrenos43f66a62005-03-25 12:31:53 -060011819 /*
11820 * Suspend/Resume resets the PCI configuration space, so we have to
11821 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11822 * from interfering with C3 CPU state. pci_restore_state won't help
11823 * here since it only restores the first 64 bytes pci config header.
11824 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011825 pci_read_config_dword(pdev, 0x40, &val);
11826 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011827 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11828
11829 /* Set the device back into the PRESENT state; this will also wake
11830 * the queue of needed */
11831 netif_device_attach(dev);
11832
11833 /* Bring the device back up */
11834 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011835
James Ketrenos43f66a62005-03-25 12:31:53 -060011836 return 0;
11837}
11838#endif
11839
Zhu Yic8c22c92006-08-21 11:38:39 +080011840static void ipw_pci_shutdown(struct pci_dev *pdev)
11841{
11842 struct ipw_priv *priv = pci_get_drvdata(pdev);
11843
11844 /* Take down the device; powers it off, etc. */
11845 ipw_down(priv);
11846
11847 pci_disable_device(pdev);
11848}
11849
James Ketrenos43f66a62005-03-25 12:31:53 -060011850/* driver initialization stuff */
11851static struct pci_driver ipw_driver = {
11852 .name = DRV_NAME,
11853 .id_table = card_ids,
11854 .probe = ipw_pci_probe,
11855 .remove = __devexit_p(ipw_pci_remove),
11856#ifdef CONFIG_PM
11857 .suspend = ipw_pci_suspend,
11858 .resume = ipw_pci_resume,
11859#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011860 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011861};
11862
11863static int __init ipw_init(void)
11864{
11865 int ret;
11866
11867 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11868 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11869
Jeff Garzik29917622006-08-19 17:48:59 -040011870 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011871 if (ret) {
11872 IPW_ERROR("Unable to initialize PCI module\n");
11873 return ret;
11874 }
11875
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011876 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011877 if (ret) {
11878 IPW_ERROR("Unable to create driver sysfs file\n");
11879 pci_unregister_driver(&ipw_driver);
11880 return ret;
11881 }
11882
11883 return ret;
11884}
11885
11886static void __exit ipw_exit(void)
11887{
11888 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11889 pci_unregister_driver(&ipw_driver);
11890}
11891
11892module_param(disable, int, 0444);
11893MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11894
11895module_param(associate, int, 0444);
11896MODULE_PARM_DESC(associate, "auto associate when scanning (default on)");
11897
11898module_param(auto_create, int, 0444);
11899MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11900
James Ketrenosa613bff2005-08-24 21:43:11 -050011901module_param(led, int, 0444);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011902MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011903
James Ketrenos43f66a62005-03-25 12:31:53 -060011904module_param(debug, int, 0444);
11905MODULE_PARM_DESC(debug, "debug output mask");
11906
11907module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011908MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011909
Zhu Yid685b8c2006-04-13 17:20:27 +080011910#ifdef CONFIG_IPW2200_PROMISCUOUS
11911module_param(rtap_iface, int, 0444);
11912MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11913#endif
11914
Zhu Yie43e3c12006-04-13 17:20:45 +080011915#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011916module_param(qos_enable, int, 0444);
11917MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011918
James Ketrenosb095c382005-08-24 22:04:42 -050011919module_param(qos_burst_enable, int, 0444);
11920MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11921
11922module_param(qos_no_ack_mask, int, 0444);
11923MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11924
11925module_param(burst_duration_CCK, int, 0444);
11926MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11927
11928module_param(burst_duration_OFDM, int, 0444);
11929MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011930#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011931
11932#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060011933module_param(mode, int, 0444);
11934MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
11935#else
11936module_param(mode, int, 0444);
11937MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
11938#endif
11939
Zhu Yi810dabd2006-01-24 16:36:59 +080011940module_param(bt_coexist, int, 0444);
11941MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
11942
James Ketrenosb095c382005-08-24 22:04:42 -050011943module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080011944MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050011945
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011946module_param(cmdlog, int, 0444);
11947MODULE_PARM_DESC(cmdlog,
11948 "allocate a ring buffer for logging firmware commands");
11949
Zhu Yi4bfdb912006-01-24 16:37:16 +080011950module_param(roaming, int, 0444);
11951MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
11952
Zhu Yid2b83e12006-04-13 17:19:36 +080011953module_param(antenna, int, 0444);
11954MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
11955
James Ketrenos43f66a62005-03-25 12:31:53 -060011956module_exit(ipw_exit);
11957module_init(ipw_init);