blob: 0d78e40919cf6ff1a632f3c15a040d63128de001 [file] [log] [blame]
James Ketrenos43f66a62005-03-25 12:31:53 -06001/******************************************************************************
Jeff Garzikbf794512005-07-31 13:07:26 -04002
Zhu Yi171e7b22006-02-15 07:17:56 +08003 Copyright(c) 2003 - 2006 Intel Corporation. All rights reserved.
James Ketrenos43f66a62005-03-25 12:31:53 -06004
5 802.11 status code portion of this file from ethereal-0.10.6:
6 Copyright 2000, Axis Communications AB
7 Ethereal - Network traffic analyzer
8 By Gerald Combs <gerald@ethereal.com>
9 Copyright 1998 Gerald Combs
10
Jeff Garzikbf794512005-07-31 13:07:26 -040011 This program is free software; you can redistribute it and/or modify it
12 under the terms of version 2 of the GNU General Public License as
James Ketrenos43f66a62005-03-25 12:31:53 -060013 published by the Free Software Foundation.
Jeff Garzikbf794512005-07-31 13:07:26 -040014
15 This program is distributed in the hope that it will be useful, but WITHOUT
16 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
James Ketrenos43f66a62005-03-25 12:31:53 -060018 more details.
Jeff Garzikbf794512005-07-31 13:07:26 -040019
James Ketrenos43f66a62005-03-25 12:31:53 -060020 You should have received a copy of the GNU General Public License along with
Jeff Garzikbf794512005-07-31 13:07:26 -040021 this program; if not, write to the Free Software Foundation, Inc., 59
James Ketrenos43f66a62005-03-25 12:31:53 -060022 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
Jeff Garzikbf794512005-07-31 13:07:26 -040023
James Ketrenos43f66a62005-03-25 12:31:53 -060024 The full GNU General Public License is included in this distribution in the
25 file called LICENSE.
Jeff Garzikbf794512005-07-31 13:07:26 -040026
James Ketrenos43f66a62005-03-25 12:31:53 -060027 Contact Information:
28 James P. Ketrenos <ipw2100-admin@linux.intel.com>
29 Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30
31******************************************************************************/
32
33#include "ipw2200.h"
Olaf Hering733482e2005-11-08 21:34:55 -080034#include <linux/version.h>
James Ketrenos43f66a62005-03-25 12:31:53 -060035
Zhu Yiae4af612006-04-13 17:20:34 +080036
37#ifndef KBUILD_EXTMOD
38#define VK "k"
39#else
40#define VK
41#endif
42
43#ifdef CONFIG_IPW2200_DEBUG
44#define VD "d"
45#else
46#define VD
47#endif
48
49#ifdef CONFIG_IPW2200_MONITOR
50#define VM "m"
51#else
52#define VM
53#endif
54
55#ifdef CONFIG_IPW2200_PROMISCUOUS
56#define VP "p"
57#else
58#define VP
59#endif
60
Zhu Yi459d4082006-04-13 17:21:00 +080061#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yiae4af612006-04-13 17:20:34 +080062#define VR "r"
63#else
64#define VR
65#endif
66
67#ifdef CONFIG_IPW2200_QOS
68#define VQ "q"
69#else
70#define VQ
71#endif
72
Zhu Yiee2c4ad2007-07-12 16:09:47 +080073#define IPW2200_VERSION "1.2.2" VK VD VM VP VR VQ
James Ketrenos43f66a62005-03-25 12:31:53 -060074#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2200/2915 Network Driver"
Zhu Yi171e7b22006-02-15 07:17:56 +080075#define DRV_COPYRIGHT "Copyright(c) 2003-2006 Intel Corporation"
James Ketrenos43f66a62005-03-25 12:31:53 -060076#define DRV_VERSION IPW2200_VERSION
77
James Ketrenosb095c382005-08-24 22:04:42 -050078#define ETH_P_80211_STATS (ETH_P_80211_RAW + 1)
79
James Ketrenos43f66a62005-03-25 12:31:53 -060080MODULE_DESCRIPTION(DRV_DESCRIPTION);
81MODULE_VERSION(DRV_VERSION);
82MODULE_AUTHOR(DRV_COPYRIGHT);
83MODULE_LICENSE("GPL");
84
James Ketrenosf6c5cb72005-08-25 00:39:09 -050085static int cmdlog = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060086static int debug = 0;
87static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060088static int mode = 0;
89
90static u32 ipw_debug_level;
91static int associate = 1;
92static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050093static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060094static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080095static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080096static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080097static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -060098static const char ipw_modes[] = {
99 'a', 'b', 'g', '?'
100};
Zhu Yid2b83e12006-04-13 17:19:36 +0800101static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600102
Zhu Yid685b8c2006-04-13 17:20:27 +0800103#ifdef CONFIG_IPW2200_PROMISCUOUS
104static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
105#endif
106
107
Zhu Yie43e3c12006-04-13 17:20:45 +0800108#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500109static int qos_enable = 0;
110static int qos_burst_enable = 0;
111static int qos_no_ack_mask = 0;
112static int burst_duration_CCK = 0;
113static int burst_duration_OFDM = 0;
114
115static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
116 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
117 QOS_TX3_CW_MIN_OFDM},
118 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
119 QOS_TX3_CW_MAX_OFDM},
120 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
121 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
122 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
123 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
124};
125
126static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
127 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
128 QOS_TX3_CW_MIN_CCK},
129 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
130 QOS_TX3_CW_MAX_CCK},
131 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
132 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
133 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
134 QOS_TX3_TXOP_LIMIT_CCK}
135};
136
137static struct ieee80211_qos_parameters def_parameters_OFDM = {
138 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
139 DEF_TX3_CW_MIN_OFDM},
140 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
141 DEF_TX3_CW_MAX_OFDM},
142 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
143 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
144 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
145 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
146};
147
148static struct ieee80211_qos_parameters def_parameters_CCK = {
149 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
150 DEF_TX3_CW_MIN_CCK},
151 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
152 DEF_TX3_CW_MAX_CCK},
153 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
154 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
155 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
156 DEF_TX3_TXOP_LIMIT_CCK}
157};
158
159static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
160
161static int from_priority_to_tx_queue[] = {
162 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
163 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
164};
165
166static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
167
168static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
169 *qos_param);
170static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
171 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800172#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500173
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000174static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500175static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600176static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400177static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600178 struct clx2_tx_queue *txq, int qindex);
179static int ipw_queue_reset(struct ipw_priv *priv);
180
181static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
182 int len, int sync);
183
184static void ipw_tx_queue_free(struct ipw_priv *);
185
186static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
187static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
188static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600189static int ipw_up(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000190static void ipw_bg_up(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600191static void ipw_down(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000192static void ipw_bg_down(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600193static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400194static int init_supported_rates(struct ipw_priv *priv,
195 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500196static void ipw_set_hwcrypto_keys(struct ipw_priv *);
197static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600198
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500199static int snprint_line(char *buf, size_t count,
200 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600201{
202 int out, i, j, l;
203 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400204
James Ketrenos43f66a62005-03-25 12:31:53 -0600205 out = snprintf(buf, count, "%08X", ofs);
206
207 for (l = 0, i = 0; i < 2; i++) {
208 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400209 for (j = 0; j < 8 && l < len; j++, l++)
210 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600211 data[(i * 8 + j)]);
212 for (; j < 8; j++)
213 out += snprintf(buf + out, count - out, " ");
214 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400215
James Ketrenos43f66a62005-03-25 12:31:53 -0600216 out += snprintf(buf + out, count - out, " ");
217 for (l = 0, i = 0; i < 2; i++) {
218 out += snprintf(buf + out, count - out, " ");
219 for (j = 0; j < 8 && l < len; j++, l++) {
220 c = data[(i * 8 + j)];
221 if (!isascii(c) || !isprint(c))
222 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400223
James Ketrenos43f66a62005-03-25 12:31:53 -0600224 out += snprintf(buf + out, count - out, "%c", c);
225 }
226
227 for (; j < 8; j++)
228 out += snprintf(buf + out, count - out, " ");
229 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400230
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500231 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600232}
233
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400234static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600235{
236 char line[81];
237 u32 ofs = 0;
238 if (!(ipw_debug_level & level))
239 return;
240
241 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500242 snprint_line(line, sizeof(line), &data[ofs],
243 min(len, 16U), ofs);
244 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600245 ofs += 16;
246 len -= min(len, 16U);
247 }
248}
249
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500250static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
251{
252 size_t out = size;
253 u32 ofs = 0;
254 int total = 0;
255
256 while (size && len) {
257 out = snprint_line(output, size, &data[ofs],
258 min_t(size_t, len, 16U), ofs);
259
260 ofs += 16;
261 output += out;
262 size -= out;
263 len -= min_t(size_t, len, 16U);
264 total += out;
265 }
266 return total;
267}
268
Zhu Yic8fe6672006-01-24 16:36:36 +0800269/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600270static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
271#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
272
Zhu Yic8fe6672006-01-24 16:36:36 +0800273/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600274static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
275#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
276
Zhu Yic8fe6672006-01-24 16:36:36 +0800277/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600278static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
279static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
280{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400281 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
282 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600283 _ipw_write_reg8(a, b, c);
284}
285
Zhu Yic8fe6672006-01-24 16:36:36 +0800286/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600287static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
288static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
289{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400290 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
291 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600292 _ipw_write_reg16(a, b, c);
293}
294
Zhu Yic8fe6672006-01-24 16:36:36 +0800295/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600296static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
297static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
298{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400299 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
300 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600301 _ipw_write_reg32(a, b, c);
302}
303
Zhu Yic8fe6672006-01-24 16:36:36 +0800304/* 8-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600305#define _ipw_write8(ipw, ofs, val) writeb((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800306
307/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600308#define ipw_write8(ipw, ofs, val) \
309 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
310 _ipw_write8(ipw, ofs, val)
311
Zhu Yic8fe6672006-01-24 16:36:36 +0800312/* 16-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600313#define _ipw_write16(ipw, ofs, val) writew((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800314
315/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600316#define ipw_write16(ipw, ofs, val) \
317 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
318 _ipw_write16(ipw, ofs, val)
319
Zhu Yic8fe6672006-01-24 16:36:36 +0800320/* 32-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600321#define _ipw_write32(ipw, ofs, val) writel((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800322
323/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600324#define ipw_write32(ipw, ofs, val) \
325 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
326 _ipw_write32(ipw, ofs, val)
327
Zhu Yic8fe6672006-01-24 16:36:36 +0800328/* 8-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600329#define _ipw_read8(ipw, ofs) readb((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800330
331/* 8-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400332static inline u8 __ipw_read8(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
333{
334 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600335 return _ipw_read8(ipw, ofs);
336}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400337
Zhu Yic8fe6672006-01-24 16:36:36 +0800338/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600339#define ipw_read8(ipw, ofs) __ipw_read8(__FILE__, __LINE__, ipw, ofs)
340
Zhu Yic8fe6672006-01-24 16:36:36 +0800341/* 16-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600342#define _ipw_read16(ipw, ofs) readw((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800343
344/* 16-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400345static inline u16 __ipw_read16(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
346{
347 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600348 return _ipw_read16(ipw, ofs);
349}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400350
Zhu Yic8fe6672006-01-24 16:36:36 +0800351/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600352#define ipw_read16(ipw, ofs) __ipw_read16(__FILE__, __LINE__, ipw, ofs)
353
Zhu Yic8fe6672006-01-24 16:36:36 +0800354/* 32-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600355#define _ipw_read32(ipw, ofs) readl((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800356
357/* 32-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400358static inline u32 __ipw_read32(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
359{
360 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600361 return _ipw_read32(ipw, ofs);
362}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400363
Zhu Yic8fe6672006-01-24 16:36:36 +0800364/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600365#define ipw_read32(ipw, ofs) __ipw_read32(__FILE__, __LINE__, ipw, ofs)
366
Zhu Yic8fe6672006-01-24 16:36:36 +0800367/* multi-byte read (above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600368static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500369static inline void __ipw_read_indirect(const char *f, int l,
370 struct ipw_priv *a, u32 b, u8 * c, int d)
371{
372 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %d bytes\n", f, l, (u32) (b),
373 d);
374 _ipw_read_indirect(a, b, c, d);
375}
376
Zhu Yic8fe6672006-01-24 16:36:36 +0800377/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500378#define ipw_read_indirect(a, b, c, d) __ipw_read_indirect(__FILE__, __LINE__, a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600379
Zhu Yic8fe6672006-01-24 16:36:36 +0800380/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400381static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
382 int num);
James Ketrenos43f66a62005-03-25 12:31:53 -0600383#define ipw_write_indirect(a, b, c, d) \
384 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %d bytes\n", __FILE__, __LINE__, (u32)(b), d); \
James Ketrenosafbf30a2005-08-25 00:05:33 -0500385 _ipw_write_indirect(a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600386
Zhu Yic8fe6672006-01-24 16:36:36 +0800387/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400388static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600389{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400390 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500391 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
392 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600393}
394
Zhu Yic8fe6672006-01-24 16:36:36 +0800395/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600396static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
397{
Zhu Yi2638bc32006-01-24 16:37:52 +0800398 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800399 u32 dif_len = reg - aligned_addr;
400
James Ketrenos43f66a62005-03-25 12:31:53 -0600401 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800402 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
403 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600404}
405
Zhu Yic8fe6672006-01-24 16:36:36 +0800406/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400407static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600408{
Zhu Yi2638bc32006-01-24 16:37:52 +0800409 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800410 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
411
James Ketrenos43f66a62005-03-25 12:31:53 -0600412 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800413 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
414 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600415}
416
Zhu Yic8fe6672006-01-24 16:36:36 +0800417/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600418static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
419{
420 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500421 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600422 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500423 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400424 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600425}
426
Zhu Yic8fe6672006-01-24 16:36:36 +0800427/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600428static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
429{
430 u32 value;
431
432 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
433
James Ketrenosb095c382005-08-24 22:04:42 -0500434 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
435 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600436 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
437 return value;
438}
439
Zhu Yic8fe6672006-01-24 16:36:36 +0800440/* General purpose, no alignment requirement, iterative (multi-byte) read, */
441/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600442static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
443 int num)
444{
Zhu Yi2638bc32006-01-24 16:37:52 +0800445 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600446 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600447 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400448
James Ketrenos43f66a62005-03-25 12:31:53 -0600449 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
450
James Ketrenosea2b26e2005-08-24 21:25:16 -0500451 if (num <= 0) {
452 return;
453 }
454
Zhu Yic8fe6672006-01-24 16:36:36 +0800455 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600456 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500457 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600458 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500459 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500460 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600461 aligned_addr += 4;
462 }
463
Zhu Yic8fe6672006-01-24 16:36:36 +0800464 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500465 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500466 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500467 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400468
Zhu Yic8fe6672006-01-24 16:36:36 +0800469 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500470 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500471 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500472 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500473 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500474 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600475}
476
Zhu Yic8fe6672006-01-24 16:36:36 +0800477/* General purpose, no alignment requirement, iterative (multi-byte) write, */
478/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400479static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600480 int num)
481{
Zhu Yi2638bc32006-01-24 16:37:52 +0800482 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600483 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600484 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400485
James Ketrenos43f66a62005-03-25 12:31:53 -0600486 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400487
James Ketrenosea2b26e2005-08-24 21:25:16 -0500488 if (num <= 0) {
489 return;
490 }
491
Zhu Yic8fe6672006-01-24 16:36:36 +0800492 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600493 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500494 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800495 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500496 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500497 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600498 aligned_addr += 4;
499 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400500
Zhu Yic8fe6672006-01-24 16:36:36 +0800501 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500502 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500503 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500504 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400505
Zhu Yic8fe6672006-01-24 16:36:36 +0800506 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500507 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500508 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500509 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500510 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500511 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600512}
513
Zhu Yic8fe6672006-01-24 16:36:36 +0800514/* General purpose, no alignment requirement, iterative (multi-byte) write, */
515/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400516static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600517 int num)
518{
519 memcpy_toio((priv->hw_base + addr), buf, num);
520}
521
Zhu Yic8fe6672006-01-24 16:36:36 +0800522/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600523static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
524{
525 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
526}
527
Zhu Yic8fe6672006-01-24 16:36:36 +0800528/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600529static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
530{
531 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
532}
533
Zhu Yi89c318e2006-06-08 22:19:49 -0700534static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600535{
536 if (priv->status & STATUS_INT_ENABLED)
537 return;
538 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500539 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600540}
541
Zhu Yi89c318e2006-06-08 22:19:49 -0700542static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600543{
544 if (!(priv->status & STATUS_INT_ENABLED))
545 return;
546 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500547 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600548}
549
Zhu Yi89c318e2006-06-08 22:19:49 -0700550static inline void ipw_enable_interrupts(struct ipw_priv *priv)
551{
552 unsigned long flags;
553
554 spin_lock_irqsave(&priv->irq_lock, flags);
555 __ipw_enable_interrupts(priv);
556 spin_unlock_irqrestore(&priv->irq_lock, flags);
557}
558
559static inline void ipw_disable_interrupts(struct ipw_priv *priv)
560{
561 unsigned long flags;
562
563 spin_lock_irqsave(&priv->irq_lock, flags);
564 __ipw_disable_interrupts(priv);
565 spin_unlock_irqrestore(&priv->irq_lock, flags);
566}
567
James Ketrenos43f66a62005-03-25 12:31:53 -0600568static char *ipw_error_desc(u32 val)
569{
570 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400571 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600572 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400573 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600574 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400575 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600576 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400577 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600578 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400579 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500580 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400581 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500582 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400583 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500584 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500586 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500588 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500590 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500592 return "DMA_STATUS";
593 case IPW_FW_ERROR_DINO_ERROR:
594 return "DINO_ERROR";
595 case IPW_FW_ERROR_EEPROM_ERROR:
596 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400597 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500598 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600603 }
604}
605
James Ketrenosb39860c2005-08-12 09:36:32 -0500606static void ipw_dump_error_log(struct ipw_priv *priv,
607 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600608{
James Ketrenosb39860c2005-08-12 09:36:32 -0500609 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600610
James Ketrenosb39860c2005-08-12 09:36:32 -0500611 if (!error) {
612 IPW_ERROR("Error allocating and capturing error log. "
613 "Nothing to dump.\n");
614 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600615 }
616
James Ketrenosb39860c2005-08-12 09:36:32 -0500617 IPW_ERROR("Start IPW Error Log Dump:\n");
618 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
619 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600620
James Ketrenosb39860c2005-08-12 09:36:32 -0500621 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400622 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 ipw_error_desc(error->elem[i].desc),
624 error->elem[i].time,
625 error->elem[i].blink1,
626 error->elem[i].blink2,
627 error->elem[i].link1,
628 error->elem[i].link2, error->elem[i].data);
629 for (i = 0; i < error->log_len; i++)
630 IPW_ERROR("%i\t0x%08x\t%i\n",
631 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500632 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600633}
James Ketrenos43f66a62005-03-25 12:31:53 -0600634
James Ketrenosc848d0a2005-08-24 21:56:24 -0500635static inline int ipw_is_init(struct ipw_priv *priv)
636{
637 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600638}
639
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400640static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600641{
642 u32 addr, field_info, field_len, field_count, total_len;
643
644 IPW_DEBUG_ORD("ordinal = %i\n", ord);
645
646 if (!priv || !val || !len) {
647 IPW_DEBUG_ORD("Invalid argument\n");
648 return -EINVAL;
649 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400650
James Ketrenos43f66a62005-03-25 12:31:53 -0600651 /* verify device ordinal tables have been initialized */
652 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
653 IPW_DEBUG_ORD("Access ordinals before initialization\n");
654 return -EINVAL;
655 }
656
657 switch (IPW_ORD_TABLE_ID_MASK & ord) {
658 case IPW_ORD_TABLE_0_MASK:
659 /*
660 * TABLE 0: Direct access to a table of 32 bit values
661 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400662 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600663 * read from the table
664 */
665
666 /* remove the table id from the ordinal */
667 ord &= IPW_ORD_TABLE_VALUE_MASK;
668
669 /* boundary check */
670 if (ord > priv->table0_len) {
671 IPW_DEBUG_ORD("ordinal value (%i) longer then "
672 "max (%i)\n", ord, priv->table0_len);
673 return -EINVAL;
674 }
675
676 /* verify we have enough room to store the value */
677 if (*len < sizeof(u32)) {
678 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200679 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600680 return -EINVAL;
681 }
682
683 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400684 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600685
686 *len = sizeof(u32);
687 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400688 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600689 break;
690
691 case IPW_ORD_TABLE_1_MASK:
692 /*
693 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400694 *
695 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600696 * representing starting addr for the data (which is
697 * also a u32)
698 */
699
700 /* remove the table id from the ordinal */
701 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400702
James Ketrenos43f66a62005-03-25 12:31:53 -0600703 /* boundary check */
704 if (ord > priv->table1_len) {
705 IPW_DEBUG_ORD("ordinal value too long\n");
706 return -EINVAL;
707 }
708
709 /* verify we have enough room to store the value */
710 if (*len < sizeof(u32)) {
711 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200712 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600713 return -EINVAL;
714 }
715
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400716 *((u32 *) val) =
717 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600718 *len = sizeof(u32);
719 break;
720
721 case IPW_ORD_TABLE_2_MASK:
722 /*
723 * TABLE 2: Indirect access to a table of variable sized values
724 *
725 * This table consist of six values, each containing
726 * - dword containing the starting offset of the data
727 * - dword containing the lengh in the first 16bits
728 * and the count in the second 16bits
729 */
730
731 /* remove the table id from the ordinal */
732 ord &= IPW_ORD_TABLE_VALUE_MASK;
733
734 /* boundary check */
735 if (ord > priv->table2_len) {
736 IPW_DEBUG_ORD("ordinal value too long\n");
737 return -EINVAL;
738 }
739
740 /* get the address of statistic */
741 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400742
743 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600744 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400745 field_info =
746 ipw_read_reg32(priv,
747 priv->table2_addr + (ord << 3) +
748 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400749
James Ketrenos43f66a62005-03-25 12:31:53 -0600750 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400751 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400752
James Ketrenos43f66a62005-03-25 12:31:53 -0600753 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400754 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400755
James Ketrenos43f66a62005-03-25 12:31:53 -0600756 /* abort if not enought memory */
757 total_len = field_len * field_count;
758 if (total_len > *len) {
759 *len = total_len;
760 return -EINVAL;
761 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400762
James Ketrenos43f66a62005-03-25 12:31:53 -0600763 *len = total_len;
764 if (!total_len)
765 return 0;
766
767 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400768 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600769 addr, total_len, field_info);
770 ipw_read_indirect(priv, addr, val, total_len);
771 break;
772
773 default:
774 IPW_DEBUG_ORD("Invalid ordinal!\n");
775 return -EINVAL;
776
777 }
778
James Ketrenos43f66a62005-03-25 12:31:53 -0600779 return 0;
780}
781
782static void ipw_init_ordinals(struct ipw_priv *priv)
783{
784 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400785 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600786
787 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
788 priv->table0_addr, priv->table0_len);
789
790 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
791 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
792
793 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
794 priv->table1_addr, priv->table1_len);
795
796 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
797 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400798 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600799
800 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
801 priv->table2_addr, priv->table2_len);
802
803}
804
Adrian Bunka73e22b2006-01-21 01:39:42 +0100805static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500806{
James Ketrenosb095c382005-08-24 22:04:42 -0500807 reg &= ~IPW_START_STANDBY;
808 if (reg & IPW_GATE_ODMA)
809 reg &= ~IPW_GATE_ODMA;
810 if (reg & IPW_GATE_IDMA)
811 reg &= ~IPW_GATE_IDMA;
812 if (reg & IPW_GATE_ADMA)
813 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500814 return reg;
815}
816
817/*
818 * LED behavior:
819 * - On radio ON, turn on any LEDs that require to be on during start
820 * - On initialization, start unassociated blink
821 * - On association, disable unassociated blink
822 * - On disassociation, start unassociated blink
823 * - On radio OFF, turn off any LEDs started during radio on
824 *
825 */
Zhu Yiede61112006-01-24 16:37:10 +0800826#define LD_TIME_LINK_ON msecs_to_jiffies(300)
827#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
828#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500829
Adrian Bunka73e22b2006-01-21 01:39:42 +0100830static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500831{
832 unsigned long flags;
833 u32 led;
834
835 /* If configured to not use LEDs, or nic_type is 1,
836 * then we don't toggle a LINK led */
837 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
838 return;
839
840 spin_lock_irqsave(&priv->lock, flags);
841
842 if (!(priv->status & STATUS_RF_KILL_MASK) &&
843 !(priv->status & STATUS_LED_LINK_ON)) {
844 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500845 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500846 led |= priv->led_association_on;
847
848 led = ipw_register_toggle(led);
849
850 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500851 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500852
853 priv->status |= STATUS_LED_LINK_ON;
854
855 /* If we aren't associated, schedule turning the LED off */
856 if (!(priv->status & STATUS_ASSOCIATED))
857 queue_delayed_work(priv->workqueue,
858 &priv->led_link_off,
859 LD_TIME_LINK_ON);
860 }
861
862 spin_unlock_irqrestore(&priv->lock, flags);
863}
864
David Howellsc4028952006-11-22 14:57:56 +0000865static void ipw_bg_led_link_on(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500866{
David Howellsc4028952006-11-22 14:57:56 +0000867 struct ipw_priv *priv =
868 container_of(work, struct ipw_priv, led_link_on.work);
Zhu Yi46441512006-01-24 16:37:59 +0800869 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000870 ipw_led_link_on(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800871 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500872}
873
Adrian Bunka73e22b2006-01-21 01:39:42 +0100874static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500875{
876 unsigned long flags;
877 u32 led;
878
879 /* If configured not to use LEDs, or nic type is 1,
880 * then we don't goggle the LINK led. */
881 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
882 return;
883
884 spin_lock_irqsave(&priv->lock, flags);
885
886 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500887 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500888 led &= priv->led_association_off;
889 led = ipw_register_toggle(led);
890
891 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500892 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500893
894 IPW_DEBUG_LED("Link LED Off\n");
895
896 priv->status &= ~STATUS_LED_LINK_ON;
897
898 /* If we aren't associated and the radio is on, schedule
899 * turning the LED on (blink while unassociated) */
900 if (!(priv->status & STATUS_RF_KILL_MASK) &&
901 !(priv->status & STATUS_ASSOCIATED))
902 queue_delayed_work(priv->workqueue, &priv->led_link_on,
903 LD_TIME_LINK_OFF);
904
905 }
906
907 spin_unlock_irqrestore(&priv->lock, flags);
908}
909
David Howellsc4028952006-11-22 14:57:56 +0000910static void ipw_bg_led_link_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500911{
David Howellsc4028952006-11-22 14:57:56 +0000912 struct ipw_priv *priv =
913 container_of(work, struct ipw_priv, led_link_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800914 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000915 ipw_led_link_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800916 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500917}
918
Arjan van de Ven858119e2006-01-14 13:20:43 -0800919static void __ipw_led_activity_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500920{
James Ketrenosa613bff2005-08-24 21:43:11 -0500921 u32 led;
922
923 if (priv->config & CFG_NO_LED)
924 return;
925
James Ketrenosb095c382005-08-24 22:04:42 -0500926 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -0500927 return;
James Ketrenosa613bff2005-08-24 21:43:11 -0500928
929 if (!(priv->status & STATUS_LED_ACT_ON)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500930 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500931 led |= priv->led_activity_on;
932
933 led = ipw_register_toggle(led);
934
935 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500936 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500937
938 IPW_DEBUG_LED("Activity LED On\n");
939
940 priv->status |= STATUS_LED_ACT_ON;
941
James Ketrenosc848d0a2005-08-24 21:56:24 -0500942 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -0500943 queue_delayed_work(priv->workqueue, &priv->led_act_off,
944 LD_TIME_ACT_ON);
945 } else {
946 /* Reschedule LED off for full time period */
947 cancel_delayed_work(&priv->led_act_off);
948 queue_delayed_work(priv->workqueue, &priv->led_act_off,
949 LD_TIME_ACT_ON);
950 }
James Ketrenosb095c382005-08-24 22:04:42 -0500951}
James Ketrenosa613bff2005-08-24 21:43:11 -0500952
Adrian Bunka73e22b2006-01-21 01:39:42 +0100953#if 0
James Ketrenosb095c382005-08-24 22:04:42 -0500954void ipw_led_activity_on(struct ipw_priv *priv)
955{
956 unsigned long flags;
957 spin_lock_irqsave(&priv->lock, flags);
958 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -0500959 spin_unlock_irqrestore(&priv->lock, flags);
960}
Adrian Bunka73e22b2006-01-21 01:39:42 +0100961#endif /* 0 */
James Ketrenosa613bff2005-08-24 21:43:11 -0500962
Adrian Bunka73e22b2006-01-21 01:39:42 +0100963static void ipw_led_activity_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500964{
965 unsigned long flags;
966 u32 led;
967
968 if (priv->config & CFG_NO_LED)
969 return;
970
971 spin_lock_irqsave(&priv->lock, flags);
972
973 if (priv->status & STATUS_LED_ACT_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500974 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500975 led &= priv->led_activity_off;
976
977 led = ipw_register_toggle(led);
978
979 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500980 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500981
982 IPW_DEBUG_LED("Activity LED Off\n");
983
984 priv->status &= ~STATUS_LED_ACT_ON;
985 }
986
987 spin_unlock_irqrestore(&priv->lock, flags);
988}
989
David Howellsc4028952006-11-22 14:57:56 +0000990static void ipw_bg_led_activity_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500991{
David Howellsc4028952006-11-22 14:57:56 +0000992 struct ipw_priv *priv =
993 container_of(work, struct ipw_priv, led_act_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800994 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000995 ipw_led_activity_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800996 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500997}
998
Adrian Bunka73e22b2006-01-21 01:39:42 +0100999static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001000{
1001 unsigned long flags;
1002 u32 led;
1003
1004 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001005 if (priv->config & CFG_NO_LED ||
1006 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001007 return;
1008
1009 spin_lock_irqsave(&priv->lock, flags);
1010
James Ketrenosb095c382005-08-24 22:04:42 -05001011 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001012 if (priv->assoc_network->mode == IEEE_A) {
1013 led |= priv->led_ofdm_on;
1014 led &= priv->led_association_off;
1015 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1016 } else if (priv->assoc_network->mode == IEEE_G) {
1017 led |= priv->led_ofdm_on;
1018 led |= priv->led_association_on;
1019 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1020 } else {
1021 led &= priv->led_ofdm_off;
1022 led |= priv->led_association_on;
1023 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1024 }
1025
1026 led = ipw_register_toggle(led);
1027
1028 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001029 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001030
1031 spin_unlock_irqrestore(&priv->lock, flags);
1032}
1033
Adrian Bunka73e22b2006-01-21 01:39:42 +01001034static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001035{
1036 unsigned long flags;
1037 u32 led;
1038
1039 /* Only nic type 1 supports mode LEDs */
1040 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1041 return;
1042
1043 spin_lock_irqsave(&priv->lock, flags);
1044
James Ketrenosb095c382005-08-24 22:04:42 -05001045 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001046 led &= priv->led_ofdm_off;
1047 led &= priv->led_association_off;
1048
1049 led = ipw_register_toggle(led);
1050
1051 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001052 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001053
1054 spin_unlock_irqrestore(&priv->lock, flags);
1055}
1056
Adrian Bunka73e22b2006-01-21 01:39:42 +01001057static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001058{
1059 ipw_led_link_on(priv);
1060}
1061
Adrian Bunka73e22b2006-01-21 01:39:42 +01001062static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001063{
1064 ipw_led_activity_off(priv);
1065 ipw_led_link_off(priv);
1066}
1067
Adrian Bunka73e22b2006-01-21 01:39:42 +01001068static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001069{
1070 /* Set the Link Led on for all nic types */
1071 ipw_led_link_on(priv);
1072}
1073
Adrian Bunka73e22b2006-01-21 01:39:42 +01001074static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001075{
1076 ipw_led_activity_off(priv);
1077 ipw_led_link_off(priv);
1078
1079 if (priv->status & STATUS_RF_KILL_MASK)
1080 ipw_led_radio_off(priv);
1081}
1082
Adrian Bunka73e22b2006-01-21 01:39:42 +01001083static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001084{
1085 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1086
1087 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001088 priv->led_activity_on = IPW_ACTIVITY_LED;
1089 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001090
James Ketrenosb095c382005-08-24 22:04:42 -05001091 priv->led_association_on = IPW_ASSOCIATED_LED;
1092 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001093
1094 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001095 priv->led_ofdm_on = IPW_OFDM_LED;
1096 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001097
1098 switch (priv->nic_type) {
1099 case EEPROM_NIC_TYPE_1:
1100 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001101 priv->led_activity_on = IPW_ASSOCIATED_LED;
1102 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1103 priv->led_association_on = IPW_ACTIVITY_LED;
1104 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001105
1106 if (!(priv->config & CFG_NO_LED))
1107 ipw_led_band_on(priv);
1108
1109 /* And we don't blink link LEDs for this nic, so
1110 * just return here */
1111 return;
1112
1113 case EEPROM_NIC_TYPE_3:
1114 case EEPROM_NIC_TYPE_2:
1115 case EEPROM_NIC_TYPE_4:
1116 case EEPROM_NIC_TYPE_0:
1117 break;
1118
1119 default:
1120 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1121 priv->nic_type);
1122 priv->nic_type = EEPROM_NIC_TYPE_0;
1123 break;
1124 }
1125
1126 if (!(priv->config & CFG_NO_LED)) {
1127 if (priv->status & STATUS_ASSOCIATED)
1128 ipw_led_link_on(priv);
1129 else
1130 ipw_led_link_off(priv);
1131 }
1132}
1133
Adrian Bunka73e22b2006-01-21 01:39:42 +01001134static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001135{
James Ketrenosa613bff2005-08-24 21:43:11 -05001136 ipw_led_activity_off(priv);
1137 ipw_led_link_off(priv);
1138 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001139 cancel_delayed_work(&priv->led_link_on);
1140 cancel_delayed_work(&priv->led_link_off);
1141 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001142}
1143
James Ketrenos43f66a62005-03-25 12:31:53 -06001144/*
1145 * The following adds a new attribute to the sysfs representation
1146 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1147 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001148 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001149 * See the level definitions in ipw for details.
1150 */
1151static ssize_t show_debug_level(struct device_driver *d, char *buf)
1152{
1153 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1154}
James Ketrenosa613bff2005-08-24 21:43:11 -05001155
1156static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1157 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001158{
1159 char *p = (char *)buf;
1160 u32 val;
1161
1162 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1163 p++;
1164 if (p[0] == 'x' || p[0] == 'X')
1165 p++;
1166 val = simple_strtoul(p, &p, 16);
1167 } else
1168 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001169 if (p == buf)
1170 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001171 ": %s is not in hex or decimal form.\n", buf);
1172 else
1173 ipw_debug_level = val;
1174
1175 return strnlen(buf, count);
1176}
1177
Jeff Garzikbf794512005-07-31 13:07:26 -04001178static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001179 show_debug_level, store_debug_level);
1180
James Ketrenosb39860c2005-08-12 09:36:32 -05001181static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1182{
Zhu Yic8fe6672006-01-24 16:36:36 +08001183 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001184 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1185}
1186
1187static void ipw_capture_event_log(struct ipw_priv *priv,
1188 u32 log_len, struct ipw_event *log)
1189{
1190 u32 base;
1191
1192 if (log_len) {
1193 base = ipw_read32(priv, IPW_EVENT_LOG);
1194 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1195 (u8 *) log, sizeof(*log) * log_len);
1196 }
1197}
1198
1199static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1200{
1201 struct ipw_fw_error *error;
1202 u32 log_len = ipw_get_event_log_len(priv);
1203 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1204 u32 elem_len = ipw_read_reg32(priv, base);
1205
1206 error = kmalloc(sizeof(*error) +
1207 sizeof(*error->elem) * elem_len +
1208 sizeof(*error->log) * log_len, GFP_ATOMIC);
1209 if (!error) {
1210 IPW_ERROR("Memory allocation for firmware error log "
1211 "failed.\n");
1212 return NULL;
1213 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001214 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001215 error->status = priv->status;
1216 error->config = priv->config;
1217 error->elem_len = elem_len;
1218 error->log_len = log_len;
1219 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001220 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001221
1222 ipw_capture_event_log(priv, log_len, error->log);
1223
1224 if (elem_len)
1225 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1226 sizeof(*error->elem) * elem_len);
1227
1228 return error;
1229}
1230
James Ketrenosb39860c2005-08-12 09:36:32 -05001231static ssize_t show_event_log(struct device *d,
1232 struct device_attribute *attr, char *buf)
1233{
1234 struct ipw_priv *priv = dev_get_drvdata(d);
1235 u32 log_len = ipw_get_event_log_len(priv);
Reinette Chatre412e9e72007-12-18 22:01:02 -08001236 u32 log_size;
1237 struct ipw_event *log;
James Ketrenosb39860c2005-08-12 09:36:32 -05001238 u32 len = 0, i;
1239
Reinette Chatre412e9e72007-12-18 22:01:02 -08001240 /* not using min() because of its strict type checking */
1241 log_size = PAGE_SIZE / sizeof(*log) > log_len ?
1242 sizeof(*log) * log_len : PAGE_SIZE;
1243 log = kzalloc(log_size, GFP_KERNEL);
1244 if (!log) {
1245 IPW_ERROR("Unable to allocate memory for log\n");
1246 return 0;
1247 }
1248 log_len = log_size / sizeof(*log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001249 ipw_capture_event_log(priv, log_len, log);
1250
1251 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1252 for (i = 0; i < log_len; i++)
1253 len += snprintf(buf + len, PAGE_SIZE - len,
1254 "\n%08X%08X%08X",
1255 log[i].time, log[i].event, log[i].data);
1256 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
Reinette Chatre412e9e72007-12-18 22:01:02 -08001257 kfree(log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001258 return len;
1259}
1260
1261static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1262
1263static ssize_t show_error(struct device *d,
1264 struct device_attribute *attr, char *buf)
1265{
1266 struct ipw_priv *priv = dev_get_drvdata(d);
1267 u32 len = 0, i;
1268 if (!priv->error)
1269 return 0;
1270 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001271 "%08lX%08X%08X%08X",
1272 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001273 priv->error->status,
1274 priv->error->config, priv->error->elem_len);
1275 for (i = 0; i < priv->error->elem_len; i++)
1276 len += snprintf(buf + len, PAGE_SIZE - len,
1277 "\n%08X%08X%08X%08X%08X%08X%08X",
1278 priv->error->elem[i].time,
1279 priv->error->elem[i].desc,
1280 priv->error->elem[i].blink1,
1281 priv->error->elem[i].blink2,
1282 priv->error->elem[i].link1,
1283 priv->error->elem[i].link2,
1284 priv->error->elem[i].data);
1285
1286 len += snprintf(buf + len, PAGE_SIZE - len,
1287 "\n%08X", priv->error->log_len);
1288 for (i = 0; i < priv->error->log_len; i++)
1289 len += snprintf(buf + len, PAGE_SIZE - len,
1290 "\n%08X%08X%08X",
1291 priv->error->log[i].time,
1292 priv->error->log[i].event,
1293 priv->error->log[i].data);
1294 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1295 return len;
1296}
1297
1298static ssize_t clear_error(struct device *d,
1299 struct device_attribute *attr,
1300 const char *buf, size_t count)
1301{
1302 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001303
1304 kfree(priv->error);
1305 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001306 return count;
1307}
1308
1309static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1310
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001311static ssize_t show_cmd_log(struct device *d,
1312 struct device_attribute *attr, char *buf)
1313{
1314 struct ipw_priv *priv = dev_get_drvdata(d);
1315 u32 len = 0, i;
1316 if (!priv->cmdlog)
1317 return 0;
1318 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1319 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1320 i = (i + 1) % priv->cmdlog_len) {
1321 len +=
1322 snprintf(buf + len, PAGE_SIZE - len,
1323 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1324 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1325 priv->cmdlog[i].cmd.len);
1326 len +=
1327 snprintk_buf(buf + len, PAGE_SIZE - len,
1328 (u8 *) priv->cmdlog[i].cmd.param,
1329 priv->cmdlog[i].cmd.len);
1330 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1331 }
1332 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1333 return len;
1334}
1335
1336static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1337
Zhu Yid685b8c2006-04-13 17:20:27 +08001338#ifdef CONFIG_IPW2200_PROMISCUOUS
1339static void ipw_prom_free(struct ipw_priv *priv);
1340static int ipw_prom_alloc(struct ipw_priv *priv);
1341static ssize_t store_rtap_iface(struct device *d,
1342 struct device_attribute *attr,
1343 const char *buf, size_t count)
1344{
1345 struct ipw_priv *priv = dev_get_drvdata(d);
1346 int rc = 0;
1347
1348 if (count < 1)
1349 return -EINVAL;
1350
1351 switch (buf[0]) {
1352 case '0':
1353 if (!rtap_iface)
1354 return count;
1355
1356 if (netif_running(priv->prom_net_dev)) {
1357 IPW_WARNING("Interface is up. Cannot unregister.\n");
1358 return count;
1359 }
1360
1361 ipw_prom_free(priv);
1362 rtap_iface = 0;
1363 break;
1364
1365 case '1':
1366 if (rtap_iface)
1367 return count;
1368
1369 rc = ipw_prom_alloc(priv);
1370 if (!rc)
1371 rtap_iface = 1;
1372 break;
1373
1374 default:
1375 return -EINVAL;
1376 }
1377
1378 if (rc) {
1379 IPW_ERROR("Failed to register promiscuous network "
1380 "device (error %d).\n", rc);
1381 }
1382
1383 return count;
1384}
1385
1386static ssize_t show_rtap_iface(struct device *d,
1387 struct device_attribute *attr,
1388 char *buf)
1389{
1390 struct ipw_priv *priv = dev_get_drvdata(d);
1391 if (rtap_iface)
1392 return sprintf(buf, "%s", priv->prom_net_dev->name);
1393 else {
1394 buf[0] = '-';
1395 buf[1] = '1';
1396 buf[2] = '\0';
1397 return 3;
1398 }
1399}
1400
1401static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1402 store_rtap_iface);
1403
1404static ssize_t store_rtap_filter(struct device *d,
1405 struct device_attribute *attr,
1406 const char *buf, size_t count)
1407{
1408 struct ipw_priv *priv = dev_get_drvdata(d);
1409
1410 if (!priv->prom_priv) {
1411 IPW_ERROR("Attempting to set filter without "
1412 "rtap_iface enabled.\n");
1413 return -EPERM;
1414 }
1415
1416 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1417
1418 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1419 BIT_ARG16(priv->prom_priv->filter));
1420
1421 return count;
1422}
1423
1424static ssize_t show_rtap_filter(struct device *d,
1425 struct device_attribute *attr,
1426 char *buf)
1427{
1428 struct ipw_priv *priv = dev_get_drvdata(d);
1429 return sprintf(buf, "0x%04X",
1430 priv->prom_priv ? priv->prom_priv->filter : 0);
1431}
1432
1433static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1434 store_rtap_filter);
1435#endif
1436
James Ketrenosa613bff2005-08-24 21:43:11 -05001437static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1438 char *buf)
1439{
1440 struct ipw_priv *priv = dev_get_drvdata(d);
1441 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1442}
1443
1444static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1445 const char *buf, size_t count)
1446{
1447 struct ipw_priv *priv = dev_get_drvdata(d);
1448 struct net_device *dev = priv->net_dev;
1449 char buffer[] = "00000000";
1450 unsigned long len =
1451 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1452 unsigned long val;
1453 char *p = buffer;
1454
1455 IPW_DEBUG_INFO("enter\n");
1456
1457 strncpy(buffer, buf, len);
1458 buffer[len] = 0;
1459
1460 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1461 p++;
1462 if (p[0] == 'x' || p[0] == 'X')
1463 p++;
1464 val = simple_strtoul(p, &p, 16);
1465 } else
1466 val = simple_strtoul(p, &p, 10);
1467 if (p == buffer) {
1468 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1469 } else {
1470 priv->ieee->scan_age = val;
1471 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1472 }
1473
1474 IPW_DEBUG_INFO("exit\n");
1475 return len;
1476}
1477
1478static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1479
1480static ssize_t show_led(struct device *d, struct device_attribute *attr,
1481 char *buf)
1482{
1483 struct ipw_priv *priv = dev_get_drvdata(d);
1484 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1485}
1486
1487static ssize_t store_led(struct device *d, struct device_attribute *attr,
1488 const char *buf, size_t count)
1489{
1490 struct ipw_priv *priv = dev_get_drvdata(d);
1491
1492 IPW_DEBUG_INFO("enter\n");
1493
1494 if (count == 0)
1495 return 0;
1496
1497 if (*buf == 0) {
1498 IPW_DEBUG_LED("Disabling LED control.\n");
1499 priv->config |= CFG_NO_LED;
1500 ipw_led_shutdown(priv);
1501 } else {
1502 IPW_DEBUG_LED("Enabling LED control.\n");
1503 priv->config &= ~CFG_NO_LED;
1504 ipw_led_init(priv);
1505 }
1506
1507 IPW_DEBUG_INFO("exit\n");
1508 return count;
1509}
1510
1511static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1512
Andrew Mortonad3fee52005-06-20 14:30:36 -07001513static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001514 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001515{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001516 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001517 return sprintf(buf, "0x%08x\n", (int)p->status);
1518}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001519
James Ketrenos43f66a62005-03-25 12:31:53 -06001520static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1521
Andrew Mortonad3fee52005-06-20 14:30:36 -07001522static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1523 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001524{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001525 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001526 return sprintf(buf, "0x%08x\n", (int)p->config);
1527}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001528
James Ketrenos43f66a62005-03-25 12:31:53 -06001529static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1530
Andrew Mortonad3fee52005-06-20 14:30:36 -07001531static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001532 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001533{
James Ketrenosa613bff2005-08-24 21:43:11 -05001534 struct ipw_priv *priv = d->driver_data;
1535 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001536}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001537
James Ketrenos43f66a62005-03-25 12:31:53 -06001538static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1539
Andrew Mortonad3fee52005-06-20 14:30:36 -07001540static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001541 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001542{
1543 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001544 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001545
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001546 if (ipw_get_ordinal(p, IPW_ORD_STAT_UCODE_VERSION, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001547 return 0;
1548
1549 return sprintf(buf, "0x%08x\n", tmp);
1550}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001551
1552static DEVICE_ATTR(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001553
Andrew Mortonad3fee52005-06-20 14:30:36 -07001554static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1555 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001556{
1557 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001558 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001559
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001560 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001561 return 0;
1562
1563 return sprintf(buf, "0x%08x\n", tmp);
1564}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001565
1566static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001567
1568/*
1569 * Add a device attribute to view/control the delay between eeprom
1570 * operations.
1571 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001572static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001573 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001574{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001575 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001576 return sprintf(buf, "%i\n", n);
1577}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001578static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001579 struct device_attribute *attr,
1580 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001581{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001582 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001583 sscanf(buf, "%i", &p->eeprom_delay);
1584 return strnlen(buf, count);
1585}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001586
1587static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1588 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001589
Andrew Mortonad3fee52005-06-20 14:30:36 -07001590static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001591 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001592{
1593 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001594 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001595
James Ketrenosb095c382005-08-24 22:04:42 -05001596 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001597 return sprintf(buf, "0x%08x\n", reg);
1598}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001599static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001600 struct device_attribute *attr,
1601 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001602{
1603 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001604 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001605
1606 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001607 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001608 return strnlen(buf, count);
1609}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001610
1611static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1612 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001613
Andrew Mortonad3fee52005-06-20 14:30:36 -07001614static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001615 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001616{
1617 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001618 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001619
1620 reg = ipw_read_reg32(p, 0x301100);
1621 return sprintf(buf, "0x%08x\n", reg);
1622}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001623static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001624 struct device_attribute *attr,
1625 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001626{
1627 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001628 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001629
1630 sscanf(buf, "%x", &reg);
1631 ipw_write_reg32(p, 0x301100, reg);
1632 return strnlen(buf, count);
1633}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001634
1635static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1636 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001637
Andrew Mortonad3fee52005-06-20 14:30:36 -07001638static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001639 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001640{
1641 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001642 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001643
Jeff Garzikbf794512005-07-31 13:07:26 -04001644 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001645 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001646 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001647 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001648
James Ketrenos43f66a62005-03-25 12:31:53 -06001649 return sprintf(buf, "0x%08x\n", reg);
1650}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001651static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001652 struct device_attribute *attr,
1653 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001654{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001655 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001656
1657 sscanf(buf, "%x", &priv->indirect_dword);
1658 priv->status |= STATUS_INDIRECT_DWORD;
1659 return strnlen(buf, count);
1660}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001661
1662static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1663 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001664
Andrew Mortonad3fee52005-06-20 14:30:36 -07001665static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001666 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001667{
1668 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001669 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001670
Jeff Garzikbf794512005-07-31 13:07:26 -04001671 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001672 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001673 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001674 reg = 0;
1675
1676 return sprintf(buf, "0x%02x\n", reg);
1677}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001678static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001679 struct device_attribute *attr,
1680 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001681{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001682 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001683
1684 sscanf(buf, "%x", &priv->indirect_byte);
1685 priv->status |= STATUS_INDIRECT_BYTE;
1686 return strnlen(buf, count);
1687}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001688
1689static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001690 show_indirect_byte, store_indirect_byte);
1691
Andrew Mortonad3fee52005-06-20 14:30:36 -07001692static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001693 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001694{
1695 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001696 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001697
Jeff Garzikbf794512005-07-31 13:07:26 -04001698 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001699 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001700 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001701 reg = 0;
1702
1703 return sprintf(buf, "0x%08x\n", reg);
1704}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001705static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001706 struct device_attribute *attr,
1707 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001708{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001709 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001710
1711 sscanf(buf, "%x", &priv->direct_dword);
1712 priv->status |= STATUS_DIRECT_DWORD;
1713 return strnlen(buf, count);
1714}
James Ketrenos43f66a62005-03-25 12:31:53 -06001715
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001716static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1717 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001718
Arjan van de Ven858119e2006-01-14 13:20:43 -08001719static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001720{
1721 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1722 priv->status |= STATUS_RF_KILL_HW;
1723 else
1724 priv->status &= ~STATUS_RF_KILL_HW;
1725
1726 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1727}
1728
Andrew Mortonad3fee52005-06-20 14:30:36 -07001729static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001730 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001731{
1732 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001733 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001734 2 - HW based RF kill active
1735 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001736 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001737 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001738 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001739 return sprintf(buf, "%i\n", val);
1740}
1741
1742static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1743{
Jeff Garzikbf794512005-07-31 13:07:26 -04001744 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001745 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001746 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001747
1748 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1749 disable_radio ? "OFF" : "ON");
1750
1751 if (disable_radio) {
1752 priv->status |= STATUS_RF_KILL_SW;
1753
Dan Williams0b531672007-10-09 13:55:24 -04001754 if (priv->workqueue) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001755 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -04001756 cancel_delayed_work(&priv->scan_event);
1757 }
James Ketrenos43f66a62005-03-25 12:31:53 -06001758 queue_work(priv->workqueue, &priv->down);
1759 } else {
1760 priv->status &= ~STATUS_RF_KILL_SW;
1761 if (rf_kill_active(priv)) {
1762 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1763 "disabled by HW switch\n");
1764 /* Make sure the RF_KILL check timer is running */
1765 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001766 queue_delayed_work(priv->workqueue, &priv->rf_kill,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05001767 round_jiffies_relative(2 * HZ));
Jeff Garzikbf794512005-07-31 13:07:26 -04001768 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001769 queue_work(priv->workqueue, &priv->up);
1770 }
1771
1772 return 1;
1773}
1774
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001775static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1776 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001777{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001778 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001779
James Ketrenos43f66a62005-03-25 12:31:53 -06001780 ipw_radio_kill_sw(priv, buf[0] == '1');
1781
1782 return count;
1783}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001784
1785static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001786
James Ketrenosb095c382005-08-24 22:04:42 -05001787static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1788 char *buf)
1789{
1790 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1791 int pos = 0, len = 0;
1792 if (priv->config & CFG_SPEED_SCAN) {
1793 while (priv->speed_scan[pos] != 0)
1794 len += sprintf(&buf[len], "%d ",
1795 priv->speed_scan[pos++]);
1796 return len + sprintf(&buf[len], "\n");
1797 }
1798
1799 return sprintf(buf, "0\n");
1800}
1801
1802static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1803 const char *buf, size_t count)
1804{
1805 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1806 int channel, pos = 0;
1807 const char *p = buf;
1808
1809 /* list of space separated channels to scan, optionally ending with 0 */
1810 while ((channel = simple_strtol(p, NULL, 0))) {
1811 if (pos == MAX_SPEED_SCAN - 1) {
1812 priv->speed_scan[pos] = 0;
1813 break;
1814 }
1815
Larry Finger1867b112006-02-28 09:48:28 -06001816 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001817 priv->speed_scan[pos++] = channel;
1818 else
1819 IPW_WARNING("Skipping invalid channel request: %d\n",
1820 channel);
1821 p = strchr(p, ' ');
1822 if (!p)
1823 break;
1824 while (*p == ' ' || *p == '\t')
1825 p++;
1826 }
1827
1828 if (pos == 0)
1829 priv->config &= ~CFG_SPEED_SCAN;
1830 else {
1831 priv->speed_scan_pos = 0;
1832 priv->config |= CFG_SPEED_SCAN;
1833 }
1834
1835 return count;
1836}
1837
1838static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1839 store_speed_scan);
1840
1841static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1842 char *buf)
1843{
1844 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1845 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1846}
1847
1848static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1849 const char *buf, size_t count)
1850{
1851 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1852 if (buf[0] == '1')
1853 priv->config |= CFG_NET_STATS;
1854 else
1855 priv->config &= ~CFG_NET_STATS;
1856
1857 return count;
1858}
1859
James Ketrenosafbf30a2005-08-25 00:05:33 -05001860static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1861 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001862
Zhu Yi375dd242007-02-14 16:04:24 +08001863static ssize_t show_channels(struct device *d,
1864 struct device_attribute *attr,
1865 char *buf)
1866{
1867 struct ipw_priv *priv = dev_get_drvdata(d);
Andrew Morton742e9912007-03-01 08:19:29 -05001868 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi375dd242007-02-14 16:04:24 +08001869 int len = 0, i;
1870
1871 len = sprintf(&buf[len],
1872 "Displaying %d channels in 2.4Ghz band "
1873 "(802.11bg):\n", geo->bg_channels);
1874
1875 for (i = 0; i < geo->bg_channels; i++) {
1876 len += sprintf(&buf[len], "%d: BSS%s%s, %s, Band %s.\n",
1877 geo->bg[i].channel,
1878 geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT ?
1879 " (radar spectrum)" : "",
1880 ((geo->bg[i].flags & IEEE80211_CH_NO_IBSS) ||
1881 (geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT))
1882 ? "" : ", IBSS",
1883 geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1884 "passive only" : "active/passive",
1885 geo->bg[i].flags & IEEE80211_CH_B_ONLY ?
1886 "B" : "B/G");
1887 }
1888
1889 len += sprintf(&buf[len],
1890 "Displaying %d channels in 5.2Ghz band "
1891 "(802.11a):\n", geo->a_channels);
1892 for (i = 0; i < geo->a_channels; i++) {
1893 len += sprintf(&buf[len], "%d: BSS%s%s, %s.\n",
1894 geo->a[i].channel,
1895 geo->a[i].flags & IEEE80211_CH_RADAR_DETECT ?
1896 " (radar spectrum)" : "",
1897 ((geo->a[i].flags & IEEE80211_CH_NO_IBSS) ||
1898 (geo->a[i].flags & IEEE80211_CH_RADAR_DETECT))
1899 ? "" : ", IBSS",
1900 geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1901 "passive only" : "active/passive");
1902 }
1903
1904 return len;
1905}
1906
1907static DEVICE_ATTR(channels, S_IRUSR, show_channels, NULL);
1908
James Ketrenosea2b26e2005-08-24 21:25:16 -05001909static void notify_wx_assoc_event(struct ipw_priv *priv)
1910{
1911 union iwreq_data wrqu;
1912 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1913 if (priv->status & STATUS_ASSOCIATED)
1914 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1915 else
1916 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1917 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1918}
1919
James Ketrenos43f66a62005-03-25 12:31:53 -06001920static void ipw_irq_tasklet(struct ipw_priv *priv)
1921{
1922 u32 inta, inta_mask, handled = 0;
1923 unsigned long flags;
1924 int rc = 0;
1925
Zhu Yi89c318e2006-06-08 22:19:49 -07001926 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001927
James Ketrenosb095c382005-08-24 22:04:42 -05001928 inta = ipw_read32(priv, IPW_INTA_RW);
1929 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1930 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001931
1932 /* Add any cached INTA values that need to be handled */
1933 inta |= priv->isr_inta;
1934
Zhu Yi89c318e2006-06-08 22:19:49 -07001935 spin_unlock_irqrestore(&priv->irq_lock, flags);
1936
1937 spin_lock_irqsave(&priv->lock, flags);
1938
James Ketrenos43f66a62005-03-25 12:31:53 -06001939 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001940 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001941 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001942 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001943 }
1944
James Ketrenosb095c382005-08-24 22:04:42 -05001945 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001946 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001947 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001948 priv->status &= ~STATUS_HCMD_ACTIVE;
1949 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001950 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001951 }
1952
James Ketrenosb095c382005-08-24 22:04:42 -05001953 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001954 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001955 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001956 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001957 }
1958
James Ketrenosb095c382005-08-24 22:04:42 -05001959 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001960 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001961 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001962 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001963 }
1964
James Ketrenosb095c382005-08-24 22:04:42 -05001965 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001966 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001967 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001968 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001969 }
1970
James Ketrenosb095c382005-08-24 22:04:42 -05001971 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001972 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001973 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001974 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001975 }
1976
James Ketrenosb095c382005-08-24 22:04:42 -05001977 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001978 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001979 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001980 }
1981
James Ketrenosb095c382005-08-24 22:04:42 -05001982 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001983 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001984 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06001985 }
1986
James Ketrenosb095c382005-08-24 22:04:42 -05001987 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001988 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001989 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001990 }
1991
James Ketrenosb095c382005-08-24 22:04:42 -05001992 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001993 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001994 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001995 }
1996
James Ketrenosb095c382005-08-24 22:04:42 -05001997 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001998 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001999 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002000 }
2001
James Ketrenosb095c382005-08-24 22:04:42 -05002002 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002003 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
2004 priv->status |= STATUS_RF_KILL_HW;
2005 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05002006 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06002007 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -04002008 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -05002009 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06002010 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05002011 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002012 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002013
James Ketrenosb095c382005-08-24 22:04:42 -05002014 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002015 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002016 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002017 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002018 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
2019 struct ipw_fw_error *error =
2020 ipw_alloc_error_log(priv);
2021 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07002022 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002023 }
James Ketrenosb39860c2005-08-12 09:36:32 -05002024 } else {
2025 priv->error = ipw_alloc_error_log(priv);
2026 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002027 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002028 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002029 IPW_DEBUG_FW("Error allocating sysfs 'error' "
2030 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002031 if (ipw_debug_level & IPW_DL_FW_ERRORS)
2032 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002033 }
2034
James Ketrenosb095c382005-08-24 22:04:42 -05002035 /* XXX: If hardware encryption is for WPA/WPA2,
2036 * we have to notify the supplicant. */
2037 if (priv->ieee->sec.encrypt) {
2038 priv->status &= ~STATUS_ASSOCIATED;
2039 notify_wx_assoc_event(priv);
2040 }
2041
2042 /* Keep the restart process from trying to send host
2043 * commands by clearing the INIT status bit */
2044 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05002045
2046 /* Cancel currently queued command. */
2047 priv->status &= ~STATUS_HCMD_ACTIVE;
2048 wake_up_interruptible(&priv->wait_command_queue);
2049
James Ketrenos43f66a62005-03-25 12:31:53 -06002050 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05002051 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002052 }
2053
James Ketrenosb095c382005-08-24 22:04:42 -05002054 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002055 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002056 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002057 }
2058
2059 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002060 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002061 }
2062
Zhu Yi89c318e2006-06-08 22:19:49 -07002063 spin_unlock_irqrestore(&priv->lock, flags);
2064
James Ketrenos43f66a62005-03-25 12:31:53 -06002065 /* enable all interrupts */
2066 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002067}
Jeff Garzikbf794512005-07-31 13:07:26 -04002068
James Ketrenos43f66a62005-03-25 12:31:53 -06002069#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2070static char *get_cmd_string(u8 cmd)
2071{
2072 switch (cmd) {
2073 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002074 IPW_CMD(POWER_DOWN);
2075 IPW_CMD(SYSTEM_CONFIG);
2076 IPW_CMD(MULTICAST_ADDRESS);
2077 IPW_CMD(SSID);
2078 IPW_CMD(ADAPTER_ADDRESS);
2079 IPW_CMD(PORT_TYPE);
2080 IPW_CMD(RTS_THRESHOLD);
2081 IPW_CMD(FRAG_THRESHOLD);
2082 IPW_CMD(POWER_MODE);
2083 IPW_CMD(WEP_KEY);
2084 IPW_CMD(TGI_TX_KEY);
2085 IPW_CMD(SCAN_REQUEST);
2086 IPW_CMD(SCAN_REQUEST_EXT);
2087 IPW_CMD(ASSOCIATE);
2088 IPW_CMD(SUPPORTED_RATES);
2089 IPW_CMD(SCAN_ABORT);
2090 IPW_CMD(TX_FLUSH);
2091 IPW_CMD(QOS_PARAMETERS);
2092 IPW_CMD(DINO_CONFIG);
2093 IPW_CMD(RSN_CAPABILITIES);
2094 IPW_CMD(RX_KEY);
2095 IPW_CMD(CARD_DISABLE);
2096 IPW_CMD(SEED_NUMBER);
2097 IPW_CMD(TX_POWER);
2098 IPW_CMD(COUNTRY_INFO);
2099 IPW_CMD(AIRONET_INFO);
2100 IPW_CMD(AP_TX_POWER);
2101 IPW_CMD(CCKM_INFO);
2102 IPW_CMD(CCX_VER_INFO);
2103 IPW_CMD(SET_CALIBRATION);
2104 IPW_CMD(SENSITIVITY_CALIB);
2105 IPW_CMD(RETRY_LIMIT);
2106 IPW_CMD(IPW_PRE_POWER_DOWN);
2107 IPW_CMD(VAP_BEACON_TEMPLATE);
2108 IPW_CMD(VAP_DTIM_PERIOD);
2109 IPW_CMD(EXT_SUPPORTED_RATES);
2110 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2111 IPW_CMD(VAP_QUIET_INTERVALS);
2112 IPW_CMD(VAP_CHANNEL_SWITCH);
2113 IPW_CMD(VAP_MANDATORY_CHANNELS);
2114 IPW_CMD(VAP_CELL_PWR_LIMIT);
2115 IPW_CMD(VAP_CF_PARAM_SET);
2116 IPW_CMD(VAP_SET_BEACONING_STATE);
2117 IPW_CMD(MEASUREMENT);
2118 IPW_CMD(POWER_CAPABILITY);
2119 IPW_CMD(SUPPORTED_CHANNELS);
2120 IPW_CMD(TPC_REPORT);
2121 IPW_CMD(WME_INFO);
2122 IPW_CMD(PRODUCTION_COMMAND);
2123 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002124 return "UNKNOWN";
2125 }
2126}
James Ketrenos43f66a62005-03-25 12:31:53 -06002127
2128#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002129
2130static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002131{
2132 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002133 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002134
James Ketrenosa613bff2005-08-24 21:43:11 -05002135 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002136 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002137 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2138 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002139 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002140 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002141 }
2142
2143 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002144
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002145 if (priv->cmdlog) {
2146 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2147 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2148 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2149 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2150 cmd->len);
2151 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2152 }
2153
James Ketrenosb095c382005-08-24 22:04:42 -05002154 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2155 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2156 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002157
2158#ifndef DEBUG_CMD_WEP_KEY
2159 if (cmd->cmd == IPW_CMD_WEP_KEY)
2160 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2161 else
2162#endif
2163 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2164
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002165 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002166 if (rc) {
2167 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002168 IPW_ERROR("Failed to send %s: Reason %d\n",
2169 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002170 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002171 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002172 }
2173 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002174
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002175 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2176 !(priv->
2177 status & STATUS_HCMD_ACTIVE),
2178 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002179 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002180 spin_lock_irqsave(&priv->lock, flags);
2181 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002182 IPW_ERROR("Failed to send %s: Command timed out.\n",
2183 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002184 priv->status &= ~STATUS_HCMD_ACTIVE;
2185 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002186 rc = -EIO;
2187 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002188 }
2189 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002190 } else
2191 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002192
James Ketrenosb095c382005-08-24 22:04:42 -05002193 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002194 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2195 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002196 rc = -EIO;
2197 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002198 }
2199
Zhu Yi2638bc32006-01-24 16:37:52 +08002200 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002201 if (priv->cmdlog) {
2202 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2203 priv->cmdlog_pos %= priv->cmdlog_len;
2204 }
2205 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002206}
2207
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002208static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002209{
2210 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002211 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002212 };
2213
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002214 return __ipw_send_cmd(priv, &cmd);
2215}
2216
2217static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2218 void *data)
2219{
2220 struct host_cmd cmd = {
2221 .cmd = command,
2222 .len = len,
2223 .param = data,
2224 };
2225
2226 return __ipw_send_cmd(priv, &cmd);
2227}
2228
2229static int ipw_send_host_complete(struct ipw_priv *priv)
2230{
James Ketrenos43f66a62005-03-25 12:31:53 -06002231 if (!priv) {
2232 IPW_ERROR("Invalid args\n");
2233 return -1;
2234 }
2235
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002236 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002237}
2238
Zhu Yid685b8c2006-04-13 17:20:27 +08002239static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002240{
Zhu Yid685b8c2006-04-13 17:20:27 +08002241 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2242 sizeof(priv->sys_config),
2243 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002244}
2245
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002246static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002247{
James Ketrenos43f66a62005-03-25 12:31:53 -06002248 if (!priv || !ssid) {
2249 IPW_ERROR("Invalid args\n");
2250 return -1;
2251 }
2252
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002253 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002254 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002255}
2256
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002257static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002258{
James Ketrenos43f66a62005-03-25 12:31:53 -06002259 if (!priv || !mac) {
2260 IPW_ERROR("Invalid args\n");
2261 return -1;
2262 }
2263
Joe Perches0795af52007-10-03 17:59:30 -07002264 IPW_DEBUG_INFO("%s: Setting MAC to %s\n",
2265 priv->net_dev->name, print_mac(mac, mac));
James Ketrenos43f66a62005-03-25 12:31:53 -06002266
Zhu Yi2638bc32006-01-24 16:37:52 +08002267 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002268}
2269
James Ketrenosa613bff2005-08-24 21:43:11 -05002270/*
2271 * NOTE: This must be executed from our workqueue as it results in udelay
2272 * being called which may corrupt the keyboard if executed on default
2273 * workqueue
2274 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002275static void ipw_adapter_restart(void *adapter)
2276{
2277 struct ipw_priv *priv = adapter;
2278
2279 if (priv->status & STATUS_RF_KILL_MASK)
2280 return;
2281
2282 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002283
2284 if (priv->assoc_network &&
2285 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2286 ipw_remove_current_network(priv);
2287
James Ketrenos43f66a62005-03-25 12:31:53 -06002288 if (ipw_up(priv)) {
2289 IPW_ERROR("Failed to up device\n");
2290 return;
2291 }
2292}
2293
David Howellsc4028952006-11-22 14:57:56 +00002294static void ipw_bg_adapter_restart(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002295{
David Howellsc4028952006-11-22 14:57:56 +00002296 struct ipw_priv *priv =
2297 container_of(work, struct ipw_priv, adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08002298 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002299 ipw_adapter_restart(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002300 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002301}
2302
James Ketrenos43f66a62005-03-25 12:31:53 -06002303#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2304
2305static void ipw_scan_check(void *data)
2306{
2307 struct ipw_priv *priv = data;
2308 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2309 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002310 "adapter after (%dms).\n",
2311 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002312 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002313 }
2314}
2315
David Howellsc4028952006-11-22 14:57:56 +00002316static void ipw_bg_scan_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002317{
David Howellsc4028952006-11-22 14:57:56 +00002318 struct ipw_priv *priv =
2319 container_of(work, struct ipw_priv, scan_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08002320 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002321 ipw_scan_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002322 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002323}
2324
James Ketrenos43f66a62005-03-25 12:31:53 -06002325static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2326 struct ipw_scan_request_ext *request)
2327{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002328 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002329 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002330}
2331
2332static int ipw_send_scan_abort(struct ipw_priv *priv)
2333{
James Ketrenos43f66a62005-03-25 12:31:53 -06002334 if (!priv) {
2335 IPW_ERROR("Invalid args\n");
2336 return -1;
2337 }
2338
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002339 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002340}
2341
2342static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2343{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002344 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002345 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002346 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002347
2348 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002349 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002350}
2351
2352static int ipw_send_associate(struct ipw_priv *priv,
2353 struct ipw_associate *associate)
2354{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002355 if (!priv || !associate) {
2356 IPW_ERROR("Invalid args\n");
2357 return -1;
2358 }
2359
Al Viro5b5e8072007-12-27 01:54:06 -05002360 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(*associate),
2361 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{
Al Viroe62e1ee2007-12-27 01:36:46 -05002392 __le32 v = cpu_to_le32(phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002393 if (!priv) {
2394 IPW_ERROR("Invalid args\n");
2395 return -1;
2396 }
2397
Al Viroe62e1ee2007-12-27 01:36:46 -05002398 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(v), &v);
James Ketrenos43f66a62005-03-25 12:31:53 -06002399}
James Ketrenos43f66a62005-03-25 12:31:53 -06002400
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002401static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002402{
James Ketrenos43f66a62005-03-25 12:31:53 -06002403 if (!priv || !power) {
2404 IPW_ERROR("Invalid args\n");
2405 return -1;
2406 }
2407
Zhu Yi2638bc32006-01-24 16:37:52 +08002408 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002409}
James Ketrenos43f66a62005-03-25 12:31:53 -06002410
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002411static int ipw_set_tx_power(struct ipw_priv *priv)
2412{
Larry Finger1867b112006-02-28 09:48:28 -06002413 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002414 struct ipw_tx_power tx_power;
2415 s8 max_power;
2416 int i;
2417
2418 memset(&tx_power, 0, sizeof(tx_power));
2419
2420 /* configure device for 'G' band */
2421 tx_power.ieee_mode = IPW_G_MODE;
2422 tx_power.num_channels = geo->bg_channels;
2423 for (i = 0; i < geo->bg_channels; i++) {
2424 max_power = geo->bg[i].max_power;
2425 tx_power.channels_tx_power[i].channel_number =
2426 geo->bg[i].channel;
2427 tx_power.channels_tx_power[i].tx_power = max_power ?
2428 min(max_power, priv->tx_power) : priv->tx_power;
2429 }
2430 if (ipw_send_tx_power(priv, &tx_power))
2431 return -EIO;
2432
2433 /* configure device to also handle 'B' band */
2434 tx_power.ieee_mode = IPW_B_MODE;
2435 if (ipw_send_tx_power(priv, &tx_power))
2436 return -EIO;
2437
2438 /* configure device to also handle 'A' band */
2439 if (priv->ieee->abg_true) {
2440 tx_power.ieee_mode = IPW_A_MODE;
2441 tx_power.num_channels = geo->a_channels;
2442 for (i = 0; i < tx_power.num_channels; i++) {
2443 max_power = geo->a[i].max_power;
2444 tx_power.channels_tx_power[i].channel_number =
2445 geo->a[i].channel;
2446 tx_power.channels_tx_power[i].tx_power = max_power ?
2447 min(max_power, priv->tx_power) : priv->tx_power;
2448 }
2449 if (ipw_send_tx_power(priv, &tx_power))
2450 return -EIO;
2451 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002452 return 0;
2453}
2454
2455static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2456{
2457 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002458 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002459 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002460
2461 if (!priv) {
2462 IPW_ERROR("Invalid args\n");
2463 return -1;
2464 }
2465
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002466 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2467 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002468}
2469
2470static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2471{
2472 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002473 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002474 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002475
2476 if (!priv) {
2477 IPW_ERROR("Invalid args\n");
2478 return -1;
2479 }
2480
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002481 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2482 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002483}
2484
2485static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2486{
Al Viroe62e1ee2007-12-27 01:36:46 -05002487 __le32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002488
2489 if (!priv) {
2490 IPW_ERROR("Invalid args\n");
2491 return -1;
2492 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002493
James Ketrenos43f66a62005-03-25 12:31:53 -06002494 /* If on battery, set to 3, if AC set to CAM, else user
2495 * level */
2496 switch (mode) {
2497 case IPW_POWER_BATTERY:
Al Viroe62e1ee2007-12-27 01:36:46 -05002498 param = cpu_to_le32(IPW_POWER_INDEX_3);
James Ketrenos43f66a62005-03-25 12:31:53 -06002499 break;
2500 case IPW_POWER_AC:
Al Viroe62e1ee2007-12-27 01:36:46 -05002501 param = cpu_to_le32(IPW_POWER_MODE_CAM);
James Ketrenos43f66a62005-03-25 12:31:53 -06002502 break;
2503 default:
Al Viroe62e1ee2007-12-27 01:36:46 -05002504 param = cpu_to_le32(mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06002505 break;
2506 }
2507
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002508 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002509 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002510}
2511
James Ketrenosafbf30a2005-08-25 00:05:33 -05002512static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2513{
2514 struct ipw_retry_limit retry_limit = {
2515 .short_retry_limit = slimit,
2516 .long_retry_limit = llimit
2517 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002518
2519 if (!priv) {
2520 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002521 return -1;
2522 }
2523
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002524 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002525 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002526}
2527
2528/*
2529 * The IPW device contains a Microwire compatible EEPROM that stores
2530 * various data like the MAC address. Usually the firmware has exclusive
2531 * access to the eeprom, but during device initialization (before the
2532 * device driver has sent the HostComplete command to the firmware) the
2533 * device driver has read access to the EEPROM by way of indirect addressing
2534 * through a couple of memory mapped registers.
2535 *
2536 * The following is a simplified implementation for pulling data out of the
2537 * the eeprom, along with some helper functions to find information in
2538 * the per device private data's copy of the eeprom.
2539 *
2540 * NOTE: To better understand how these functions work (i.e what is a chip
2541 * select and why do have to keep driving the eeprom clock?), read
2542 * just about any data sheet for a Microwire compatible EEPROM.
2543 */
2544
2545/* write a 32 bit value into the indirect accessor register */
2546static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2547{
2548 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002549
James Ketrenos43f66a62005-03-25 12:31:53 -06002550 /* the eeprom requires some time to complete the operation */
2551 udelay(p->eeprom_delay);
2552
2553 return;
2554}
2555
2556/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002557static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002558{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002559 eeprom_write_reg(priv, 0);
2560 eeprom_write_reg(priv, EEPROM_BIT_CS);
2561 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2562 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002563}
2564
2565/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002566static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002567{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002568 eeprom_write_reg(priv, EEPROM_BIT_CS);
2569 eeprom_write_reg(priv, 0);
2570 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002571}
2572
2573/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002574static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002575{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002576 int d = (bit ? EEPROM_BIT_DI : 0);
2577 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2578 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002579}
2580
2581/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002582static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002583{
2584 int i;
2585
2586 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002587 eeprom_write_bit(priv, 1);
2588 eeprom_write_bit(priv, op & 2);
2589 eeprom_write_bit(priv, op & 1);
2590 for (i = 7; i >= 0; i--) {
2591 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002592 }
2593}
2594
2595/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002596static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002597{
2598 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002599 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002600
James Ketrenos43f66a62005-03-25 12:31:53 -06002601 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002602 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002603
2604 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002605 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002606
2607 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002608 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002609 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002610 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2611 eeprom_write_reg(priv, EEPROM_BIT_CS);
2612 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2613 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002614 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002615
James Ketrenos43f66a62005-03-25 12:31:53 -06002616 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002617 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002618 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002619
James Ketrenos43f66a62005-03-25 12:31:53 -06002620 return r;
2621}
2622
2623/* helper function for pulling the mac address out of the private */
2624/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002625static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002626{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002627 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002628}
2629
2630/*
2631 * Either the device driver (i.e. the host) or the firmware can
2632 * load eeprom data into the designated region in SRAM. If neither
2633 * happens then the FW will shutdown with a fatal error.
2634 *
2635 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2636 * bit needs region of shared SRAM needs to be non-zero.
2637 */
2638static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2639{
2640 int i;
Al Viroe62e1ee2007-12-27 01:36:46 -05002641 __le16 *eeprom = (__le16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002642
James Ketrenos43f66a62005-03-25 12:31:53 -06002643 IPW_DEBUG_TRACE(">>\n");
2644
2645 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002646 for (i = 0; i < 128; i++)
Al Viroe62e1ee2007-12-27 01:36:46 -05002647 eeprom[i] = cpu_to_le16(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002648
Jeff Garzikbf794512005-07-31 13:07:26 -04002649 /*
2650 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002651 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002652 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002653 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002654 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002655 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2656
2657 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002658 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002659 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002660
2661 /* Do not load eeprom data on fatal error or suspend */
2662 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2663 } else {
2664 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2665
2666 /* Load eeprom data on fatal error or suspend */
2667 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2668 }
2669
2670 IPW_DEBUG_TRACE("<<\n");
2671}
2672
Arjan van de Ven858119e2006-01-14 13:20:43 -08002673static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002674{
2675 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002676 if (!count)
2677 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002678 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002679 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002680 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002681}
2682
2683static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2684{
James Ketrenosb095c382005-08-24 22:04:42 -05002685 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002686 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002687 sizeof(struct command_block));
2688}
2689
2690static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002691{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002692
2693 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002694
James Ketrenos43f66a62005-03-25 12:31:53 -06002695 /* Start the dma */
2696 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002697
James Ketrenos43f66a62005-03-25 12:31:53 -06002698 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002699 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002700
2701 IPW_DEBUG_FW("<< : \n");
2702 return 0;
2703}
2704
2705static void ipw_fw_dma_abort(struct ipw_priv *priv)
2706{
2707 u32 control = 0;
2708
2709 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002710
Pavel Machek67fd6b42006-07-11 15:34:05 +02002711 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002712 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002713 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002714 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002715
James Ketrenos43f66a62005-03-25 12:31:53 -06002716 IPW_DEBUG_FW("<< \n");
2717}
2718
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002719static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2720 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002721{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002722 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002723 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002724 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002725 IPW_DEBUG_FW(">> :\n");
2726
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002727 ipw_write_indirect(priv, address, (u8 *) cb,
2728 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002729
2730 IPW_DEBUG_FW("<< :\n");
2731 return 0;
2732
2733}
2734
2735static int ipw_fw_dma_kick(struct ipw_priv *priv)
2736{
2737 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002738 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002739
2740 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002741
James Ketrenos43f66a62005-03-25 12:31:53 -06002742 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002743 ipw_fw_dma_write_command_block(priv, index,
2744 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002745
2746 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002747 ipw_clear_bit(priv, IPW_RESET_REG,
2748 IPW_RESET_REG_MASTER_DISABLED |
2749 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002750
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002751 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002752 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002753 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002754
2755 IPW_DEBUG_FW("<< :\n");
2756 return 0;
2757}
2758
2759static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2760{
2761 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002762 u32 register_value = 0;
2763 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002764
2765 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002766 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002767 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002768
2769 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002770 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2771 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002772
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002773 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002774 cb_fields_address = address;
2775 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002776 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002777
2778 cb_fields_address += sizeof(u32);
2779 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002780 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002781
2782 cb_fields_address += sizeof(u32);
2783 register_value = ipw_read_reg32(priv, cb_fields_address);
2784 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2785 register_value);
2786
2787 cb_fields_address += sizeof(u32);
2788 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002789 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002790
2791 IPW_DEBUG_FW(">> :\n");
2792}
2793
2794static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2795{
2796 u32 current_cb_address = 0;
2797 u32 current_cb_index = 0;
2798
2799 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002800 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002801
James Ketrenosb095c382005-08-24 22:04:42 -05002802 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002803 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002804
James Ketrenos43f66a62005-03-25 12:31:53 -06002805 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002806 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002807
2808 IPW_DEBUG_FW(">> :\n");
2809 return current_cb_index;
2810
2811}
2812
2813static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2814 u32 src_address,
2815 u32 dest_address,
2816 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002817 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002818{
2819
Jeff Garzikbf794512005-07-31 13:07:26 -04002820 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002821 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2822 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002823 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002824 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002825
2826 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2827 src_address, dest_address, length);
2828
2829 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2830 return -1;
2831
2832 last_cb_element = priv->sram_desc.last_cb_index;
2833 cb = &priv->sram_desc.cb_list[last_cb_element];
2834 priv->sram_desc.last_cb_index++;
2835
2836 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002837 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002838 control |= CB_INT_ENABLED;
2839
2840 if (is_last)
2841 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002842
James Ketrenos43f66a62005-03-25 12:31:53 -06002843 control |= length;
2844
2845 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002846 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002847
2848 /* Copy the Source and Destination addresses */
2849 cb->dest_addr = dest_address;
2850 cb->source_addr = src_address;
2851
2852 /* Copy the Control Word last */
2853 cb->control = control;
2854
2855 return 0;
2856}
2857
2858static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002859 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002860{
2861 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002862 u32 src_offset = 0;
2863 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002864 int status = 0;
2865 IPW_DEBUG_FW(">> \n");
2866 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2867 src_phys, dest_address, length);
2868 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002869 status = ipw_fw_dma_add_command_block(priv,
2870 src_phys + src_offset,
2871 dest_address +
2872 dest_offset,
2873 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002874 if (status) {
2875 IPW_DEBUG_FW_INFO(": Failed\n");
2876 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002877 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002878 IPW_DEBUG_FW_INFO(": Added new cb\n");
2879
2880 src_offset += CB_MAX_LENGTH;
2881 dest_offset += CB_MAX_LENGTH;
2882 bytes_left -= CB_MAX_LENGTH;
2883 }
2884
2885 /* add the buffer tail */
2886 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002887 status =
2888 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2889 dest_address + dest_offset,
2890 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002891 if (status) {
2892 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2893 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002894 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002895 IPW_DEBUG_FW_INFO
2896 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002897 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002898
James Ketrenos43f66a62005-03-25 12:31:53 -06002899 IPW_DEBUG_FW("<< \n");
2900 return 0;
2901}
2902
2903static int ipw_fw_dma_wait(struct ipw_priv *priv)
2904{
Zhu Yi397ae122006-01-24 16:37:22 +08002905 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002906 u32 watchdog = 0;
2907
2908 IPW_DEBUG_FW(">> : \n");
2909
2910 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002911 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002912 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002913
2914 while (current_index < priv->sram_desc.last_cb_index) {
2915 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002916 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002917 current_index = ipw_fw_dma_command_block_index(priv);
2918
Zhu Yi397ae122006-01-24 16:37:22 +08002919 if (previous_index < current_index) {
2920 watchdog = 0;
2921 continue;
2922 }
2923 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002924 IPW_DEBUG_FW_INFO("Timeout\n");
2925 ipw_fw_dma_dump_command_block(priv);
2926 ipw_fw_dma_abort(priv);
2927 return -1;
2928 }
2929 }
2930
2931 ipw_fw_dma_abort(priv);
2932
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002933 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002934 ipw_set_bit(priv, IPW_RESET_REG,
2935 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002936
2937 IPW_DEBUG_FW("<< dmaWaitSync \n");
2938 return 0;
2939}
2940
Jeff Garzikbf794512005-07-31 13:07:26 -04002941static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002942{
2943 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002944 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002945 unsigned long flags;
2946
2947 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002948 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2949 network = list_entry(element, struct ieee80211_network, list);
2950 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2951 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002952 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002953 &priv->ieee->network_free_list);
2954 }
2955 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002956 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002957}
2958
2959/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002960 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002961 * Reads debug register from domain0.
2962 * If card is present, pre-defined value should
2963 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002964 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002965 * @param priv
2966 * @return 1 if card is present, 0 otherwise
2967 */
2968static inline int ipw_alive(struct ipw_priv *priv)
2969{
2970 return ipw_read32(priv, 0x90) == 0xd55555d5;
2971}
2972
Zhu Yic7b6a672006-01-24 16:37:05 +08002973/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002974static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002975 int timeout)
2976{
2977 int i = 0;
2978
2979 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002980 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002981 return i;
2982 mdelay(10);
2983 i += 10;
2984 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04002985
James Ketrenos43f66a62005-03-25 12:31:53 -06002986 return -ETIME;
2987}
2988
Jeff Garzikbf794512005-07-31 13:07:26 -04002989/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06002990 * the ipw hardware. It assumes the buffer has all the bits for the
2991 * image and the caller is handling the memory allocation and clean up.
2992 */
2993
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002994static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002995{
2996 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002997
James Ketrenos43f66a62005-03-25 12:31:53 -06002998 IPW_DEBUG_TRACE(">> \n");
2999 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05003000 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003001
Zhu Yic7b6a672006-01-24 16:37:05 +08003002 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05003003 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3004 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06003005 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003006 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003007 return -1;
3008 }
3009
3010 IPW_DEBUG_INFO("stop master %dms\n", rc);
3011
3012 return rc;
3013}
3014
3015static void ipw_arc_release(struct ipw_priv *priv)
3016{
3017 IPW_DEBUG_TRACE(">> \n");
3018 mdelay(5);
3019
James Ketrenosb095c382005-08-24 22:04:42 -05003020 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003021
3022 /* no one knows timing, for safety add some delay */
3023 mdelay(5);
3024}
3025
James Ketrenos43f66a62005-03-25 12:31:53 -06003026struct fw_chunk {
Al Viroe62e1ee2007-12-27 01:36:46 -05003027 __le32 address;
3028 __le32 length;
James Ketrenos43f66a62005-03-25 12:31:53 -06003029};
3030
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003031static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003032{
3033 int rc = 0, i, addr;
3034 u8 cr = 0;
Al Viroe62e1ee2007-12-27 01:36:46 -05003035 __le16 *image;
James Ketrenos43f66a62005-03-25 12:31:53 -06003036
Al Viroe62e1ee2007-12-27 01:36:46 -05003037 image = (__le16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04003038
James Ketrenos43f66a62005-03-25 12:31:53 -06003039 IPW_DEBUG_TRACE(">> \n");
3040
3041 rc = ipw_stop_master(priv);
3042
3043 if (rc < 0)
3044 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003045
James Ketrenosb095c382005-08-24 22:04:42 -05003046 for (addr = IPW_SHARED_LOWER_BOUND;
3047 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003048 ipw_write32(priv, addr, 0);
3049 }
3050
3051 /* no ucode (yet) */
3052 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3053 /* destroy DMA queues */
3054 /* reset sequence */
3055
James Ketrenosb095c382005-08-24 22:04:42 -05003056 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003057 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003058 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003059 mdelay(1);
3060
3061 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003062 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003063 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003064
James Ketrenosb095c382005-08-24 22:04:42 -05003065 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003066 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003067
James Ketrenos43f66a62005-03-25 12:31:53 -06003068 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003069 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3070 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003071 mdelay(1);
3072
3073 /* write ucode */
3074 /**
3075 * @bug
3076 * Do NOT set indirect address register once and then
3077 * store data to indirect data register in the loop.
3078 * It seems very reasonable, but in this case DINO do not
3079 * accept ucode. It is essential to set address each time.
3080 */
3081 /* load new ipw uCode */
3082 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003083 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
Al Viroe62e1ee2007-12-27 01:36:46 -05003084 le16_to_cpu(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003085
James Ketrenos43f66a62005-03-25 12:31:53 -06003086 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003087 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3088 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003089
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003090 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003091
3092 /* wait for alive response */
3093 for (i = 0; i < 100; i++) {
3094 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003095 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003096 if (cr & DINO_RXFIFO_DATA)
3097 break;
3098 mdelay(1);
3099 }
3100
3101 if (cr & DINO_RXFIFO_DATA) {
3102 /* alive_command_responce size is NOT multiple of 4 */
Al Viroe62e1ee2007-12-27 01:36:46 -05003103 __le32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003104
3105 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003106 response_buffer[i] =
Al Viroe62e1ee2007-12-27 01:36:46 -05003107 cpu_to_le32(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003108 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003109 memcpy(&priv->dino_alive, response_buffer,
3110 sizeof(priv->dino_alive));
3111 if (priv->dino_alive.alive_command == 1
3112 && priv->dino_alive.ucode_valid == 1) {
3113 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003114 IPW_DEBUG_INFO
3115 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3116 "of %02d/%02d/%02d %02d:%02d\n",
3117 priv->dino_alive.software_revision,
3118 priv->dino_alive.software_revision,
3119 priv->dino_alive.device_identifier,
3120 priv->dino_alive.device_identifier,
3121 priv->dino_alive.time_stamp[0],
3122 priv->dino_alive.time_stamp[1],
3123 priv->dino_alive.time_stamp[2],
3124 priv->dino_alive.time_stamp[3],
3125 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003126 } else {
3127 IPW_DEBUG_INFO("Microcode is not alive\n");
3128 rc = -EINVAL;
3129 }
3130 } else {
3131 IPW_DEBUG_INFO("No alive response from DINO\n");
3132 rc = -ETIME;
3133 }
3134
3135 /* disable DINO, otherwise for some reason
3136 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003137 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003138
James Ketrenos43f66a62005-03-25 12:31:53 -06003139 return rc;
3140}
3141
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003142static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003143{
3144 int rc = -1;
3145 int offset = 0;
3146 struct fw_chunk *chunk;
3147 dma_addr_t shared_phys;
3148 u8 *shared_virt;
3149
3150 IPW_DEBUG_TRACE("<< : \n");
3151 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3152
3153 if (!shared_virt)
3154 return -ENOMEM;
3155
3156 memmove(shared_virt, data, len);
3157
3158 /* Start the Dma */
3159 rc = ipw_fw_dma_enable(priv);
3160
3161 if (priv->sram_desc.last_cb_index > 0) {
3162 /* the DMA is already ready this would be a bug. */
3163 BUG();
3164 goto out;
3165 }
3166
3167 do {
3168 chunk = (struct fw_chunk *)(data + offset);
3169 offset += sizeof(struct fw_chunk);
3170 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003171 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003172 * offeset*/
3173 /* Dma loading */
3174 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003175 le32_to_cpu(chunk->address),
3176 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003177 if (rc) {
3178 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3179 goto out;
3180 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003181
James Ketrenosa613bff2005-08-24 21:43:11 -05003182 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003183 } while (offset < len);
3184
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003185 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003186 rc = ipw_fw_dma_kick(priv);
3187 if (rc) {
3188 IPW_ERROR("dmaKick Failed\n");
3189 goto out;
3190 }
3191
3192 rc = ipw_fw_dma_wait(priv);
3193 if (rc) {
3194 IPW_ERROR("dmaWaitSync Failed\n");
3195 goto out;
3196 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003197 out:
3198 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003199 return rc;
3200}
3201
3202/* stop nic */
3203static int ipw_stop_nic(struct ipw_priv *priv)
3204{
3205 int rc = 0;
3206
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003207 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003208 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003209
James Ketrenosb095c382005-08-24 22:04:42 -05003210 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3211 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003212 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003213 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003214 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003215 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003216
James Ketrenosb095c382005-08-24 22:04:42 -05003217 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003218
James Ketrenos43f66a62005-03-25 12:31:53 -06003219 return rc;
3220}
3221
3222static void ipw_start_nic(struct ipw_priv *priv)
3223{
3224 IPW_DEBUG_TRACE(">>\n");
3225
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003226 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003227 ipw_clear_bit(priv, IPW_RESET_REG,
3228 IPW_RESET_REG_MASTER_DISABLED |
3229 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003230 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003231
James Ketrenos43f66a62005-03-25 12:31:53 -06003232 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003233 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3234 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003235
3236 IPW_DEBUG_TRACE("<<\n");
3237}
Jeff Garzikbf794512005-07-31 13:07:26 -04003238
James Ketrenos43f66a62005-03-25 12:31:53 -06003239static int ipw_init_nic(struct ipw_priv *priv)
3240{
3241 int rc;
3242
3243 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003244 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003245 /*prvHwInitNic */
3246 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003247 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003248
3249 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003250 ipw_write32(priv, IPW_READ_INT_REGISTER,
3251 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003252
3253 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003254 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3255 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003256 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003257 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3258
3259 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003260 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003261
3262 udelay(10);
3263
3264 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003265 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003266
3267 IPW_DEBUG_TRACE(">>\n");
3268 return 0;
3269}
3270
Jeff Garzikbf794512005-07-31 13:07:26 -04003271/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003272 * Probe is an ok place to call this from.
3273 */
3274static int ipw_reset_nic(struct ipw_priv *priv)
3275{
3276 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003277 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003278
3279 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003280
James Ketrenos43f66a62005-03-25 12:31:53 -06003281 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003282
James Ketrenosa613bff2005-08-24 21:43:11 -05003283 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003284 /* Clear the 'host command active' bit... */
3285 priv->status &= ~STATUS_HCMD_ACTIVE;
3286 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003287 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3288 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003289 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003290
3291 IPW_DEBUG_TRACE("<<\n");
3292 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003293}
James Ketrenos43f66a62005-03-25 12:31:53 -06003294
James Ketrenos9006ea72006-03-08 03:22:28 +08003295
3296struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003297 __le32 ver;
3298 __le32 boot_size;
3299 __le32 ucode_size;
3300 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003301 u8 data[0];
3302};
3303
Jeff Garzikbf794512005-07-31 13:07:26 -04003304static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003305 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003306{
James Ketrenos9006ea72006-03-08 03:22:28 +08003307 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003308 int rc;
3309
3310 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003311 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003312 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003313 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003314 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003315 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003316
James Ketrenos9006ea72006-03-08 03:22:28 +08003317 if ((*raw)->size < sizeof(*fw)) {
3318 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003319 return -EINVAL;
3320 }
3321
James Ketrenos9006ea72006-03-08 03:22:28 +08003322 fw = (void *)(*raw)->data;
3323
Zhu Yi0070f8c2006-04-13 17:20:12 +08003324 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3325 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003326 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3327 name, (*raw)->size);
3328 return -EINVAL;
3329 }
3330
3331 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003332 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003333 le32_to_cpu(fw->ver) >> 16,
3334 le32_to_cpu(fw->ver) & 0xff,
3335 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003336 return 0;
3337}
3338
James Ketrenosb095c382005-08-24 22:04:42 -05003339#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003340
Arjan van de Ven858119e2006-01-14 13:20:43 -08003341static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003342 struct ipw_rx_queue *rxq)
3343{
3344 unsigned long flags;
3345 int i;
3346
3347 spin_lock_irqsave(&rxq->lock, flags);
3348
3349 INIT_LIST_HEAD(&rxq->rx_free);
3350 INIT_LIST_HEAD(&rxq->rx_used);
3351
3352 /* Fill the rx_used queue with _all_ of the Rx buffers */
3353 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3354 /* In the reset function, these buffers may have been allocated
3355 * to an SKB, so we need to unmap and free potential storage */
3356 if (rxq->pool[i].skb != NULL) {
3357 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003358 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003359 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003360 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003361 }
3362 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3363 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003364
James Ketrenos43f66a62005-03-25 12:31:53 -06003365 /* Set us so that we have processed and used all buffers, but have
3366 * not restocked the Rx queue with fresh buffers */
3367 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003368 rxq->free_count = 0;
3369 spin_unlock_irqrestore(&rxq->lock, flags);
3370}
3371
3372#ifdef CONFIG_PM
3373static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003374static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003375
3376static void free_firmware(void)
3377{
3378 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003379 release_firmware(raw);
3380 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003381 fw_loaded = 0;
3382 }
3383}
3384#else
3385#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003386#endif
3387
3388static int ipw_load(struct ipw_priv *priv)
3389{
3390#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003391 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003392#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003393 struct ipw_fw *fw;
3394 u8 *boot_img, *ucode_img, *fw_img;
3395 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003396 int rc = 0, retries = 3;
3397
Zhu Yi397ae122006-01-24 16:37:22 +08003398 switch (priv->ieee->iw_mode) {
3399 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003400 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003401 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003402#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003403 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003404 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003405 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003406#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003407 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003408 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003409 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003410 }
Zhu Yi397ae122006-01-24 16:37:22 +08003411
James Ketrenos9006ea72006-03-08 03:22:28 +08003412 if (!name) {
3413 rc = -EINVAL;
3414 goto error;
3415 }
3416
3417#ifdef CONFIG_PM
3418 if (!fw_loaded) {
3419#endif
3420 rc = ipw_get_fw(priv, &raw, name);
3421 if (rc < 0)
3422 goto error;
3423#ifdef CONFIG_PM
3424 }
3425#endif
3426
3427 fw = (void *)raw->data;
3428 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003429 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3430 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3431 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003432
Zhu Yi397ae122006-01-24 16:37:22 +08003433 if (rc < 0)
3434 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003435
3436 if (!priv->rxq)
3437 priv->rxq = ipw_rx_queue_alloc(priv);
3438 else
3439 ipw_rx_queue_reset(priv, priv->rxq);
3440 if (!priv->rxq) {
3441 IPW_ERROR("Unable to initialize Rx queue\n");
3442 goto error;
3443 }
3444
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003445 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003446 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003447 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003448 priv->status &= ~STATUS_INT_ENABLED;
3449
3450 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003451 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003452
James Ketrenos43f66a62005-03-25 12:31:53 -06003453 ipw_stop_nic(priv);
3454
3455 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003456 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003457 IPW_ERROR("Unable to reset NIC\n");
3458 goto error;
3459 }
3460
James Ketrenosb095c382005-08-24 22:04:42 -05003461 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3462 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003463
3464 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003465 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003466 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003467 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003468 goto error;
3469 }
3470
3471 /* kick start the device */
3472 ipw_start_nic(priv);
3473
Zhu Yic7b6a672006-01-24 16:37:05 +08003474 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003475 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3476 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003477 if (rc < 0) {
3478 IPW_ERROR("device failed to boot initial fw image\n");
3479 goto error;
3480 }
3481 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3482
Jeff Garzikbf794512005-07-31 13:07:26 -04003483 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003484 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003485
3486 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003487 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003488 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003489 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003490 goto error;
3491 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003492
James Ketrenos43f66a62005-03-25 12:31:53 -06003493 /* stop nic */
3494 ipw_stop_nic(priv);
3495
3496 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003497 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003498 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003499 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003500 goto error;
3501 }
Zhu Yi397ae122006-01-24 16:37:22 +08003502#ifdef CONFIG_PM
3503 fw_loaded = 1;
3504#endif
3505
James Ketrenos43f66a62005-03-25 12:31:53 -06003506 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3507
3508 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003509 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003510 IPW_ERROR("Unable to initialize queues\n");
3511 goto error;
3512 }
3513
3514 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003515 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003516 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003517 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003518
James Ketrenos43f66a62005-03-25 12:31:53 -06003519 /* kick start the device */
3520 ipw_start_nic(priv);
3521
James Ketrenosb095c382005-08-24 22:04:42 -05003522 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003523 if (retries > 0) {
3524 IPW_WARNING("Parity error. Retrying init.\n");
3525 retries--;
3526 goto retry;
3527 }
3528
3529 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3530 rc = -EIO;
3531 goto error;
3532 }
3533
3534 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003535 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3536 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003537 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003538 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003539 goto error;
3540 }
3541 IPW_DEBUG_INFO("device response after %dms\n", rc);
3542
3543 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003544 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003545
3546 /* read eeprom data and initialize the eeprom region of sram */
3547 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003548 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003549
3550 /* enable interrupts */
3551 ipw_enable_interrupts(priv);
3552
3553 /* Ensure our queue has valid packets */
3554 ipw_rx_queue_replenish(priv);
3555
James Ketrenosb095c382005-08-24 22:04:42 -05003556 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003557
3558 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003559 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003560
3561#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003562 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003563#endif
3564 return 0;
3565
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003566 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003567 if (priv->rxq) {
3568 ipw_rx_queue_free(priv, priv->rxq);
3569 priv->rxq = NULL;
3570 }
3571 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003572 if (raw)
3573 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003574#ifdef CONFIG_PM
3575 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003576 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003577#endif
3578
3579 return rc;
3580}
3581
Jeff Garzikbf794512005-07-31 13:07:26 -04003582/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003583 * DMA services
3584 *
3585 * Theory of operation
3586 *
3587 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3588 * 2 empty entries always kept in the buffer to protect from overflow.
3589 *
3590 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003591 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3592 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003593 * Tx queue resumed.
3594 *
3595 * The IPW operates with six queues, one receive queue in the device's
3596 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003597 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003598 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003599 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003600 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003601 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003602 * we only utilize the first data transmit queue (queue1).
3603 */
3604
3605/**
3606 * Driver allocates buffers of this size for Rx
3607 */
3608
Dan Williams943dbef2008-02-14 17:49:41 -05003609/**
3610 * ipw_rx_queue_space - Return number of free slots available in queue.
3611 */
3612static int ipw_rx_queue_space(const struct ipw_rx_queue *q)
3613{
3614 int s = q->read - q->write;
3615 if (s <= 0)
3616 s += RX_QUEUE_SIZE;
3617 /* keep some buffer to not confuse full and empty queue */
3618 s -= 2;
3619 if (s < 0)
3620 s = 0;
3621 return s;
3622}
3623
3624static inline int ipw_tx_queue_space(const struct clx2_queue *q)
James Ketrenos43f66a62005-03-25 12:31:53 -06003625{
3626 int s = q->last_used - q->first_empty;
3627 if (s <= 0)
3628 s += q->n_bd;
3629 s -= 2; /* keep some reserve to not confuse empty and full situations */
3630 if (s < 0)
3631 s = 0;
3632 return s;
3633}
3634
3635static inline int ipw_queue_inc_wrap(int index, int n_bd)
3636{
3637 return (++index == n_bd) ? 0 : index;
3638}
3639
3640/**
3641 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003642 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003643 * @param q queue to init
3644 * @param count Number of BD's to allocate. Should be power of 2
3645 * @param read_register Address for 'read' register
3646 * (not offset within BAR, full address)
3647 * @param write_register Address for 'write' register
3648 * (not offset within BAR, full address)
3649 * @param base_register Address for 'base' register
3650 * (not offset within BAR, full address)
3651 * @param size Address for 'size' register
3652 * (not offset within BAR, full address)
3653 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003654static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003655 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003656{
3657 q->n_bd = count;
3658
3659 q->low_mark = q->n_bd / 4;
3660 if (q->low_mark < 4)
3661 q->low_mark = 4;
3662
3663 q->high_mark = q->n_bd / 8;
3664 if (q->high_mark < 2)
3665 q->high_mark = 2;
3666
3667 q->first_empty = q->last_used = 0;
3668 q->reg_r = read;
3669 q->reg_w = write;
3670
3671 ipw_write32(priv, base, q->dma_addr);
3672 ipw_write32(priv, size, count);
3673 ipw_write32(priv, read, 0);
3674 ipw_write32(priv, write, 0);
3675
3676 _ipw_read32(priv, 0x90);
3677}
3678
Jeff Garzikbf794512005-07-31 13:07:26 -04003679static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003680 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003681 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003682{
3683 struct pci_dev *dev = priv->pci_dev;
3684
3685 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3686 if (!q->txb) {
3687 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3688 return -ENOMEM;
3689 }
3690
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003691 q->bd =
3692 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003693 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003694 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003695 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003696 kfree(q->txb);
3697 q->txb = NULL;
3698 return -ENOMEM;
3699 }
3700
3701 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3702 return 0;
3703}
3704
3705/**
3706 * Free one TFD, those at index [txq->q.last_used].
3707 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003708 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003709 * @param dev
3710 * @param txq
3711 */
3712static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3713 struct clx2_tx_queue *txq)
3714{
3715 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3716 struct pci_dev *dev = priv->pci_dev;
3717 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003718
James Ketrenos43f66a62005-03-25 12:31:53 -06003719 /* classify bd */
3720 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3721 /* nothing to cleanup after for host commands */
3722 return;
3723
3724 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003725 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3726 IPW_ERROR("Too many chunks: %i\n",
3727 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003728 /** @todo issue fatal error, it is quite serious situation */
3729 return;
3730 }
3731
3732 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003733 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3734 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3735 le16_to_cpu(bd->u.data.chunk_len[i]),
3736 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003737 if (txq->txb[txq->q.last_used]) {
3738 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3739 txq->txb[txq->q.last_used] = NULL;
3740 }
3741 }
3742}
3743
3744/**
3745 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003746 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003747 * Empty queue by removing and destroying all BD's.
3748 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003749 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003750 * @param dev
3751 * @param q
3752 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003753static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003754{
3755 struct clx2_queue *q = &txq->q;
3756 struct pci_dev *dev = priv->pci_dev;
3757
Jeff Garzikbf794512005-07-31 13:07:26 -04003758 if (q->n_bd == 0)
3759 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003760
3761 /* first, empty all BD's */
3762 for (; q->first_empty != q->last_used;
3763 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3764 ipw_queue_tx_free_tfd(priv, txq);
3765 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003766
James Ketrenos43f66a62005-03-25 12:31:53 -06003767 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003768 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003769 q->dma_addr);
3770 kfree(txq->txb);
3771
3772 /* 0 fill whole structure */
3773 memset(txq, 0, sizeof(*txq));
3774}
3775
James Ketrenos43f66a62005-03-25 12:31:53 -06003776/**
3777 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003778 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003779 * @param priv
3780 */
3781static void ipw_tx_queue_free(struct ipw_priv *priv)
3782{
3783 /* Tx CMD queue */
3784 ipw_queue_tx_free(priv, &priv->txq_cmd);
3785
3786 /* Tx queues */
3787 ipw_queue_tx_free(priv, &priv->txq[0]);
3788 ipw_queue_tx_free(priv, &priv->txq[1]);
3789 ipw_queue_tx_free(priv, &priv->txq[2]);
3790 ipw_queue_tx_free(priv, &priv->txq[3]);
3791}
3792
Arjan van de Ven858119e2006-01-14 13:20:43 -08003793static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003794{
3795 /* First 3 bytes are manufacturer */
3796 bssid[0] = priv->mac_addr[0];
3797 bssid[1] = priv->mac_addr[1];
3798 bssid[2] = priv->mac_addr[2];
3799
3800 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003801 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003802
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003803 bssid[0] &= 0xfe; /* clear multicast bit */
3804 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003805}
3806
Arjan van de Ven858119e2006-01-14 13:20:43 -08003807static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003808{
3809 struct ipw_station_entry entry;
3810 int i;
Joe Perches0795af52007-10-03 17:59:30 -07003811 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06003812
3813 for (i = 0; i < priv->num_stations; i++) {
3814 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3815 /* Another node is active in network */
3816 priv->missed_adhoc_beacons = 0;
3817 if (!(priv->config & CFG_STATIC_CHANNEL))
3818 /* when other nodes drop out, we drop out */
3819 priv->config &= ~CFG_ADHOC_PERSIST;
3820
3821 return i;
3822 }
3823 }
3824
3825 if (i == MAX_STATIONS)
3826 return IPW_INVALID_STATION;
3827
Joe Perches0795af52007-10-03 17:59:30 -07003828 IPW_DEBUG_SCAN("Adding AdHoc station: %s\n", print_mac(mac, bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06003829
3830 entry.reserved = 0;
3831 entry.support_mode = 0;
3832 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3833 memcpy(priv->stations[i], bssid, ETH_ALEN);
3834 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003835 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003836 priv->num_stations++;
3837
3838 return i;
3839}
3840
Arjan van de Ven858119e2006-01-14 13:20:43 -08003841static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003842{
3843 int i;
3844
Jeff Garzikbf794512005-07-31 13:07:26 -04003845 for (i = 0; i < priv->num_stations; i++)
3846 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003847 return i;
3848
3849 return IPW_INVALID_STATION;
3850}
3851
3852static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3853{
3854 int err;
Joe Perches0795af52007-10-03 17:59:30 -07003855 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06003856
Hong Liu7b996592005-08-25 17:36:13 +08003857 if (priv->status & STATUS_ASSOCIATING) {
3858 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3859 queue_work(priv->workqueue, &priv->disassociate);
3860 return;
3861 }
3862
3863 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003864 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3865 return;
3866 }
3867
Joe Perches0795af52007-10-03 17:59:30 -07003868 IPW_DEBUG_ASSOC("Disassocation attempt from %s "
James Ketrenos43f66a62005-03-25 12:31:53 -06003869 "on channel %d.\n",
Joe Perches0795af52007-10-03 17:59:30 -07003870 print_mac(mac, priv->assoc_request.bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06003871 priv->assoc_request.channel);
3872
3873 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3874 priv->status |= STATUS_DISASSOCIATING;
3875
3876 if (quiet)
3877 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3878 else
3879 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003880
James Ketrenos43f66a62005-03-25 12:31:53 -06003881 err = ipw_send_associate(priv, &priv->assoc_request);
3882 if (err) {
3883 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3884 "failed.\n");
3885 return;
3886 }
3887
3888}
3889
James Ketrenosc848d0a2005-08-24 21:56:24 -05003890static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003891{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003892 struct ipw_priv *priv = data;
3893 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3894 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003895 ipw_send_disassociate(data, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003896 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003897}
3898
David Howellsc4028952006-11-22 14:57:56 +00003899static void ipw_bg_disassociate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06003900{
David Howellsc4028952006-11-22 14:57:56 +00003901 struct ipw_priv *priv =
3902 container_of(work, struct ipw_priv, disassociate);
Zhu Yi46441512006-01-24 16:37:59 +08003903 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00003904 ipw_disassociate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08003905 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003906}
3907
David Howellsc4028952006-11-22 14:57:56 +00003908static void ipw_system_config(struct work_struct *work)
Zhu Yid8bad6d2005-07-13 12:25:38 -05003909{
David Howellsc4028952006-11-22 14:57:56 +00003910 struct ipw_priv *priv =
3911 container_of(work, struct ipw_priv, system_config);
Zhu Yid685b8c2006-04-13 17:20:27 +08003912
3913#ifdef CONFIG_IPW2200_PROMISCUOUS
3914 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3915 priv->sys_config.accept_all_data_frames = 1;
3916 priv->sys_config.accept_non_directed_frames = 1;
3917 priv->sys_config.accept_all_mgmt_bcpr = 1;
3918 priv->sys_config.accept_all_mgmt_frames = 1;
3919 }
3920#endif
3921
3922 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003923}
3924
3925struct ipw_status_code {
3926 u16 status;
3927 const char *reason;
3928};
3929
3930static const struct ipw_status_code ipw_status_codes[] = {
3931 {0x00, "Successful"},
3932 {0x01, "Unspecified failure"},
3933 {0x0A, "Cannot support all requested capabilities in the "
3934 "Capability information field"},
3935 {0x0B, "Reassociation denied due to inability to confirm that "
3936 "association exists"},
3937 {0x0C, "Association denied due to reason outside the scope of this "
3938 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003939 {0x0D,
3940 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003941 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003942 {0x0E,
3943 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003944 "transaction sequence number out of expected sequence"},
3945 {0x0F, "Authentication rejected because of challenge failure"},
3946 {0x10, "Authentication rejected due to timeout waiting for next "
3947 "frame in sequence"},
3948 {0x11, "Association denied because AP is unable to handle additional "
3949 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003950 {0x12,
3951 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003952 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003953 {0x13,
3954 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003955 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003956 {0x14,
3957 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003958 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003959 {0x15,
3960 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003961 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003962 {0x19,
3963 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003964 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003965 {0x1A,
3966 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003967 "DSSS-OFDM operation"},
3968 {0x28, "Invalid Information Element"},
3969 {0x29, "Group Cipher is not valid"},
3970 {0x2A, "Pairwise Cipher is not valid"},
3971 {0x2B, "AKMP is not valid"},
3972 {0x2C, "Unsupported RSN IE version"},
3973 {0x2D, "Invalid RSN IE Capabilities"},
3974 {0x2E, "Cipher suite is rejected per security policy"},
3975};
3976
Jeff Garzikbf794512005-07-31 13:07:26 -04003977static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003978{
3979 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003980 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003981 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003982 return ipw_status_codes[i].reason;
3983 return "Unknown status value.";
3984}
James Ketrenos43f66a62005-03-25 12:31:53 -06003985
3986static void inline average_init(struct average *avg)
3987{
3988 memset(avg, 0, sizeof(*avg));
3989}
3990
Zhu Yi00d21de2006-04-13 17:19:02 +08003991#define DEPTH_RSSI 8
3992#define DEPTH_NOISE 16
3993static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
3994{
3995 return ((depth-1)*prev_avg + val)/depth;
3996}
3997
Arjan van de Ven858119e2006-01-14 13:20:43 -08003998static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06003999{
4000 avg->sum -= avg->entries[avg->pos];
4001 avg->sum += val;
4002 avg->entries[avg->pos++] = val;
4003 if (unlikely(avg->pos == AVG_ENTRIES)) {
4004 avg->init = 1;
4005 avg->pos = 0;
4006 }
4007}
4008
Arjan van de Ven858119e2006-01-14 13:20:43 -08004009static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06004010{
4011 if (!unlikely(avg->init)) {
4012 if (avg->pos)
4013 return avg->sum / avg->pos;
4014 return 0;
4015 }
4016
4017 return avg->sum / AVG_ENTRIES;
4018}
4019
4020static void ipw_reset_stats(struct ipw_priv *priv)
4021{
4022 u32 len = sizeof(u32);
4023
4024 priv->quality = 0;
4025
4026 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08004027 priv->exp_avg_rssi = -60;
4028 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06004029
4030 priv->last_rate = 0;
4031 priv->last_missed_beacons = 0;
4032 priv->last_rx_packets = 0;
4033 priv->last_tx_packets = 0;
4034 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04004035
James Ketrenos43f66a62005-03-25 12:31:53 -06004036 /* Firmware managed, reset only when NIC is restarted, so we have to
4037 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04004038 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06004039 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04004040 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06004041 &priv->last_tx_failures, &len);
4042
4043 /* Driver managed, reset with each association */
4044 priv->missed_adhoc_beacons = 0;
4045 priv->missed_beacons = 0;
4046 priv->tx_packets = 0;
4047 priv->rx_packets = 0;
4048
4049}
4050
Arjan van de Ven858119e2006-01-14 13:20:43 -08004051static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06004052{
4053 u32 i = 0x80000000;
4054 u32 mask = priv->rates_mask;
4055 /* If currently associated in B mode, restrict the maximum
4056 * rate match to B rates */
4057 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
4058 mask &= IEEE80211_CCK_RATES_MASK;
4059
4060 /* TODO: Verify that the rate is supported by the current rates
4061 * list. */
4062
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004063 while (i && !(mask & i))
4064 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06004065 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004066 case IEEE80211_CCK_RATE_1MB_MASK:
4067 return 1000000;
4068 case IEEE80211_CCK_RATE_2MB_MASK:
4069 return 2000000;
4070 case IEEE80211_CCK_RATE_5MB_MASK:
4071 return 5500000;
4072 case IEEE80211_OFDM_RATE_6MB_MASK:
4073 return 6000000;
4074 case IEEE80211_OFDM_RATE_9MB_MASK:
4075 return 9000000;
4076 case IEEE80211_CCK_RATE_11MB_MASK:
4077 return 11000000;
4078 case IEEE80211_OFDM_RATE_12MB_MASK:
4079 return 12000000;
4080 case IEEE80211_OFDM_RATE_18MB_MASK:
4081 return 18000000;
4082 case IEEE80211_OFDM_RATE_24MB_MASK:
4083 return 24000000;
4084 case IEEE80211_OFDM_RATE_36MB_MASK:
4085 return 36000000;
4086 case IEEE80211_OFDM_RATE_48MB_MASK:
4087 return 48000000;
4088 case IEEE80211_OFDM_RATE_54MB_MASK:
4089 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004090 }
4091
Jeff Garzikbf794512005-07-31 13:07:26 -04004092 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004093 return 11000000;
4094 else
4095 return 54000000;
4096}
4097
4098static u32 ipw_get_current_rate(struct ipw_priv *priv)
4099{
4100 u32 rate, len = sizeof(rate);
4101 int err;
4102
Jeff Garzikbf794512005-07-31 13:07:26 -04004103 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004104 return 0;
4105
4106 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004107 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004108 &len);
4109 if (err) {
4110 IPW_DEBUG_INFO("failed querying ordinals.\n");
4111 return 0;
4112 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004113 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004114 return ipw_get_max_rate(priv);
4115
4116 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004117 case IPW_TX_RATE_1MB:
4118 return 1000000;
4119 case IPW_TX_RATE_2MB:
4120 return 2000000;
4121 case IPW_TX_RATE_5MB:
4122 return 5500000;
4123 case IPW_TX_RATE_6MB:
4124 return 6000000;
4125 case IPW_TX_RATE_9MB:
4126 return 9000000;
4127 case IPW_TX_RATE_11MB:
4128 return 11000000;
4129 case IPW_TX_RATE_12MB:
4130 return 12000000;
4131 case IPW_TX_RATE_18MB:
4132 return 18000000;
4133 case IPW_TX_RATE_24MB:
4134 return 24000000;
4135 case IPW_TX_RATE_36MB:
4136 return 36000000;
4137 case IPW_TX_RATE_48MB:
4138 return 48000000;
4139 case IPW_TX_RATE_54MB:
4140 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004141 }
4142
4143 return 0;
4144}
4145
James Ketrenos43f66a62005-03-25 12:31:53 -06004146#define IPW_STATS_INTERVAL (2 * HZ)
4147static void ipw_gather_stats(struct ipw_priv *priv)
4148{
4149 u32 rx_err, rx_err_delta, rx_packets_delta;
4150 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4151 u32 missed_beacons_percent, missed_beacons_delta;
4152 u32 quality = 0;
4153 u32 len = sizeof(u32);
4154 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004155 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004156 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004157 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004158
4159 if (!(priv->status & STATUS_ASSOCIATED)) {
4160 priv->quality = 0;
4161 return;
4162 }
4163
4164 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004165 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004166 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004167 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004168 priv->last_missed_beacons = priv->missed_beacons;
4169 if (priv->assoc_request.beacon_interval) {
4170 missed_beacons_percent = missed_beacons_delta *
Al Viro5b5e8072007-12-27 01:54:06 -05004171 (HZ * le16_to_cpu(priv->assoc_request.beacon_interval)) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004172 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004173 } else {
4174 missed_beacons_percent = 0;
4175 }
4176 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4177
4178 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4179 rx_err_delta = rx_err - priv->last_rx_err;
4180 priv->last_rx_err = rx_err;
4181
4182 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4183 tx_failures_delta = tx_failures - priv->last_tx_failures;
4184 priv->last_tx_failures = tx_failures;
4185
4186 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4187 priv->last_rx_packets = priv->rx_packets;
4188
4189 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4190 priv->last_tx_packets = priv->tx_packets;
4191
4192 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004193 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004194 * Missed beacon: 100% = 0, 0% = 70% missed
4195 * Rate: 60% = 1Mbs, 100% = Max
4196 * Rx and Tx errors represent a straight % of total Rx/Tx
4197 * RSSI: 100% = > -50, 0% = < -80
4198 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004199 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004200 * The lowest computed quality is used.
4201 *
4202 */
4203#define BEACON_THRESHOLD 5
4204 beacon_quality = 100 - missed_beacons_percent;
4205 if (beacon_quality < BEACON_THRESHOLD)
4206 beacon_quality = 0;
4207 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004208 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004209 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004210 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004211 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004212
James Ketrenos43f66a62005-03-25 12:31:53 -06004213 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004214 max_rate = ipw_get_max_rate(priv);
4215 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004216 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4217 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004218
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004219 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004220 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004221 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004222 else
4223 rx_quality = 100;
4224 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4225 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004226
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004227 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004228 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004229 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004230 else
4231 tx_quality = 100;
4232 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4233 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004234
Zhu Yi00d21de2006-04-13 17:19:02 +08004235 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004236 signal_quality =
4237 (100 *
4238 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4239 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4240 (priv->ieee->perfect_rssi - rssi) *
4241 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4242 62 * (priv->ieee->perfect_rssi - rssi))) /
4243 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4244 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4245 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004246 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004247 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004248 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004249
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004250 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004251 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004252
4253 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004254 min(rate_quality,
4255 min(tx_quality, min(rx_quality, signal_quality))));
4256 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004257 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4258 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004259 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004260 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4261 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004262 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004263 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4264 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004265 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004266 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4267 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004268 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004269 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4270 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004271
4272 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004273
4274 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004275 IPW_STATS_INTERVAL);
4276}
4277
David Howellsc4028952006-11-22 14:57:56 +00004278static void ipw_bg_gather_stats(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05004279{
David Howellsc4028952006-11-22 14:57:56 +00004280 struct ipw_priv *priv =
4281 container_of(work, struct ipw_priv, gather_stats.work);
Zhu Yi46441512006-01-24 16:37:59 +08004282 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00004283 ipw_gather_stats(priv);
Zhu Yi46441512006-01-24 16:37:59 +08004284 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004285}
4286
Ben Cahille7582562005-10-06 15:34:41 -05004287/* Missed beacon behavior:
4288 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4289 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4290 * Above disassociate threshold, give up and stop scanning.
4291 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004292static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004293 int missed_count)
4294{
4295 priv->notif_missed_beacons = missed_count;
4296
James Ketrenosafbf30a2005-08-25 00:05:33 -05004297 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004298 priv->status & STATUS_ASSOCIATED) {
4299 /* If associated and we've hit the missed
4300 * beacon threshold, disassociate, turn
4301 * off roaming, and abort any active scans */
4302 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004303 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004304 "Missed beacon: %d - disassociate\n", missed_count);
4305 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004306 if (priv->status & STATUS_SCANNING) {
4307 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4308 IPW_DL_STATE,
4309 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004310 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004311 }
4312
James Ketrenosea2b26e2005-08-24 21:25:16 -05004313 queue_work(priv->workqueue, &priv->disassociate);
4314 return;
4315 }
4316
4317 if (priv->status & STATUS_ROAMING) {
4318 /* If we are currently roaming, then just
4319 * print a debug statement... */
4320 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4321 "Missed beacon: %d - roam in progress\n",
4322 missed_count);
4323 return;
4324 }
4325
Zhu Yi4bfdb912006-01-24 16:37:16 +08004326 if (roaming &&
4327 (missed_count > priv->roaming_threshold &&
4328 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004329 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004330 * bit in the status and kick off a scan.
4331 * This can happen several times before we reach
4332 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004333 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4334 "Missed beacon: %d - initiate "
4335 "roaming\n", missed_count);
4336 if (!(priv->status & STATUS_ROAMING)) {
4337 priv->status |= STATUS_ROAMING;
4338 if (!(priv->status & STATUS_SCANNING))
David Howellsc4028952006-11-22 14:57:56 +00004339 queue_delayed_work(priv->workqueue,
4340 &priv->request_scan, 0);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004341 }
4342 return;
4343 }
4344
4345 if (priv->status & STATUS_SCANNING) {
4346 /* Stop scan to keep fw from getting
4347 * stuck (only if we aren't roaming --
4348 * otherwise we'll never scan more than 2 or 3
4349 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004350 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4351 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004352 queue_work(priv->workqueue, &priv->abort_scan);
4353 }
4354
4355 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004356}
4357
Dan Williams0b531672007-10-09 13:55:24 -04004358static void ipw_scan_event(struct work_struct *work)
4359{
4360 union iwreq_data wrqu;
4361
4362 struct ipw_priv *priv =
4363 container_of(work, struct ipw_priv, scan_event.work);
4364
4365 wrqu.data.length = 0;
4366 wrqu.data.flags = 0;
4367 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4368}
4369
4370static void handle_scan_event(struct ipw_priv *priv)
4371{
4372 /* Only userspace-requested scan completion events go out immediately */
4373 if (!priv->user_requested_scan) {
4374 if (!delayed_work_pending(&priv->scan_event))
4375 queue_delayed_work(priv->workqueue, &priv->scan_event,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004376 round_jiffies_relative(msecs_to_jiffies(4000)));
Dan Williams0b531672007-10-09 13:55:24 -04004377 } else {
4378 union iwreq_data wrqu;
4379
4380 priv->user_requested_scan = 0;
4381 cancel_delayed_work(&priv->scan_event);
4382
4383 wrqu.data.length = 0;
4384 wrqu.data.flags = 0;
4385 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4386 }
4387}
4388
James Ketrenos43f66a62005-03-25 12:31:53 -06004389/**
4390 * Handle host notification packet.
4391 * Called from interrupt routine
4392 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004393static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004394 struct ipw_rx_notification *notif)
4395{
Joe Perches0795af52007-10-03 17:59:30 -07004396 DECLARE_MAC_BUF(mac);
Al Viroe62e1ee2007-12-27 01:36:46 -05004397 u16 size = le16_to_cpu(notif->size);
James Ketrenosa613bff2005-08-24 21:43:11 -05004398 notif->size = le16_to_cpu(notif->size);
4399
Al Viroe62e1ee2007-12-27 01:36:46 -05004400 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004401
James Ketrenos43f66a62005-03-25 12:31:53 -06004402 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004403 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4404 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004405
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004406 switch (assoc->state) {
4407 case CMAS_ASSOCIATED:{
4408 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4409 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004410 "associated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004411 " \n",
4412 escape_essid(priv->essid,
4413 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004414 print_mac(mac, priv->bssid));
Jeff Garzikbf794512005-07-31 13:07:26 -04004415
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004416 switch (priv->ieee->iw_mode) {
4417 case IW_MODE_INFRA:
4418 memcpy(priv->ieee->bssid,
4419 priv->bssid, ETH_ALEN);
4420 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004421
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004422 case IW_MODE_ADHOC:
4423 memcpy(priv->ieee->bssid,
4424 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004425
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004426 /* clear out the station table */
4427 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004428
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004429 IPW_DEBUG_ASSOC
4430 ("queueing adhoc check\n");
4431 queue_delayed_work(priv->
4432 workqueue,
4433 &priv->
4434 adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05004435 le16_to_cpu(priv->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004436 assoc_request.
Al Viro5b5e8072007-12-27 01:54:06 -05004437 beacon_interval));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004438 break;
4439 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004440
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004441 priv->status &= ~STATUS_ASSOCIATING;
4442 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004443 queue_work(priv->workqueue,
4444 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004445
Zhu Yie43e3c12006-04-13 17:20:45 +08004446#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004447#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
4448 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_ctl))
4449 if ((priv->status & STATUS_AUTH) &&
4450 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4451 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004452 if ((sizeof
4453 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004454 ieee80211_assoc_response)
Al Viroe62e1ee2007-12-27 01:36:46 -05004455 <= size)
4456 && (size <= 2314)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004457 struct
4458 ieee80211_rx_stats
4459 stats = {
Al Viroe62e1ee2007-12-27 01:36:46 -05004460 .len = size - 1,
James Ketrenosb095c382005-08-24 22:04:42 -05004461 };
4462
4463 IPW_DEBUG_QOS
4464 ("QoS Associate "
Al Viroe62e1ee2007-12-27 01:36:46 -05004465 "size %d\n", size);
James Ketrenosb095c382005-08-24 22:04:42 -05004466 ieee80211_rx_mgt(priv->
4467 ieee,
4468 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004469 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004470 *)
4471 &notif->u.raw, &stats);
4472 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004473 }
James Ketrenosb095c382005-08-24 22:04:42 -05004474#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004475
James Ketrenosa613bff2005-08-24 21:43:11 -05004476 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004477
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004478 break;
4479 }
4480
4481 case CMAS_AUTHENTICATED:{
4482 if (priv->
4483 status & (STATUS_ASSOCIATED |
4484 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004485 struct notif_authenticate *auth
4486 = &notif->u.auth;
4487 IPW_DEBUG(IPW_DL_NOTIF |
4488 IPW_DL_STATE |
4489 IPW_DL_ASSOC,
4490 "deauthenticated: '%s' "
Joe Perches0795af52007-10-03 17:59:30 -07004491 "%s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004492 ": (0x%04X) - %s \n",
4493 escape_essid(priv->
4494 essid,
4495 priv->
4496 essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004497 print_mac(mac, priv->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004498 ntohs(auth->status),
4499 ipw_get_status_code
4500 (ntohs
4501 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004502
4503 priv->status &=
4504 ~(STATUS_ASSOCIATING |
4505 STATUS_AUTH |
4506 STATUS_ASSOCIATED);
4507
James Ketrenosa613bff2005-08-24 21:43:11 -05004508 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004509 break;
4510 }
4511
4512 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4513 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004514 "authenticated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004515 "\n",
4516 escape_essid(priv->essid,
4517 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004518 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004519 break;
4520 }
4521
4522 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004523 if (priv->status & STATUS_AUTH) {
4524 struct
4525 ieee80211_assoc_response
4526 *resp;
4527 resp =
4528 (struct
4529 ieee80211_assoc_response
4530 *)&notif->u.raw;
4531 IPW_DEBUG(IPW_DL_NOTIF |
4532 IPW_DL_STATE |
4533 IPW_DL_ASSOC,
4534 "association failed (0x%04X): %s\n",
4535 ntohs(resp->status),
4536 ipw_get_status_code
4537 (ntohs
4538 (resp->status)));
4539 }
4540
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004541 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4542 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004543 "disassociated: '%s' %s"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004544 " \n",
4545 escape_essid(priv->essid,
4546 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004547 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004548
4549 priv->status &=
4550 ~(STATUS_DISASSOCIATING |
4551 STATUS_ASSOCIATING |
4552 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004553 if (priv->assoc_network
4554 && (priv->assoc_network->
4555 capability &
4556 WLAN_CAPABILITY_IBSS))
4557 ipw_remove_current_network
4558 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004559
James Ketrenosa613bff2005-08-24 21:43:11 -05004560 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004561
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004562 break;
4563 }
4564
James Ketrenosb095c382005-08-24 22:04:42 -05004565 case CMAS_RX_ASSOC_RESP:
4566 break;
4567
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004568 default:
4569 IPW_ERROR("assoc: unknown (%d)\n",
4570 assoc->state);
4571 break;
4572 }
4573
James Ketrenos43f66a62005-03-25 12:31:53 -06004574 break;
4575 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004576
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004577 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4578 struct notif_authenticate *auth = &notif->u.auth;
4579 switch (auth->state) {
4580 case CMAS_AUTHENTICATED:
4581 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Joe Perches0795af52007-10-03 17:59:30 -07004582 "authenticated: '%s' %s \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004583 escape_essid(priv->essid,
4584 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004585 print_mac(mac, priv->bssid));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004586 priv->status |= STATUS_AUTH;
4587 break;
4588
4589 case CMAS_INIT:
4590 if (priv->status & STATUS_AUTH) {
4591 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4592 IPW_DL_ASSOC,
4593 "authentication failed (0x%04X): %s\n",
4594 ntohs(auth->status),
4595 ipw_get_status_code(ntohs
4596 (auth->
4597 status)));
4598 }
4599 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4600 IPW_DL_ASSOC,
Joe Perches0795af52007-10-03 17:59:30 -07004601 "deauthenticated: '%s' %s\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004602 escape_essid(priv->essid,
4603 priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07004604 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06004605
4606 priv->status &= ~(STATUS_ASSOCIATING |
4607 STATUS_AUTH |
4608 STATUS_ASSOCIATED);
4609
James Ketrenosa613bff2005-08-24 21:43:11 -05004610 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004611 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004612
4613 case CMAS_TX_AUTH_SEQ_1:
4614 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4615 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4616 break;
4617 case CMAS_RX_AUTH_SEQ_2:
4618 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4619 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4620 break;
4621 case CMAS_AUTH_SEQ_1_PASS:
4622 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4623 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4624 break;
4625 case CMAS_AUTH_SEQ_1_FAIL:
4626 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4627 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4628 break;
4629 case CMAS_TX_AUTH_SEQ_3:
4630 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4631 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4632 break;
4633 case CMAS_RX_AUTH_SEQ_4:
4634 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4635 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4636 break;
4637 case CMAS_AUTH_SEQ_2_PASS:
4638 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4639 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4640 break;
4641 case CMAS_AUTH_SEQ_2_FAIL:
4642 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4643 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4644 break;
4645 case CMAS_TX_ASSOC:
4646 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4647 IPW_DL_ASSOC, "TX_ASSOC\n");
4648 break;
4649 case CMAS_RX_ASSOC_RESP:
4650 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4651 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004652
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004653 break;
4654 case CMAS_ASSOCIATED:
4655 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4656 IPW_DL_ASSOC, "ASSOCIATED\n");
4657 break;
4658 default:
4659 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4660 auth->state);
4661 break;
4662 }
4663 break;
4664 }
4665
4666 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4667 struct notif_channel_result *x =
4668 &notif->u.channel_result;
4669
Al Viroe62e1ee2007-12-27 01:36:46 -05004670 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004671 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4672 x->channel_num);
4673 } else {
4674 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4675 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004676 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004677 }
4678 break;
4679 }
4680
4681 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4682 struct notif_scan_complete *x = &notif->u.scan_complete;
Al Viroe62e1ee2007-12-27 01:36:46 -05004683 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004684 IPW_DEBUG_SCAN
4685 ("Scan completed: type %d, %d channels, "
4686 "%d status\n", x->scan_type,
4687 x->num_channels, x->status);
4688 } else {
4689 IPW_ERROR("Scan completed of wrong size %d "
4690 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004691 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004692 }
4693
4694 priv->status &=
4695 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4696
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004697 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004698 cancel_delayed_work(&priv->scan_check);
4699
James Ketrenosb095c382005-08-24 22:04:42 -05004700 if (priv->status & STATUS_EXIT_PENDING)
4701 break;
4702
4703 priv->ieee->scans++;
4704
4705#ifdef CONFIG_IPW2200_MONITOR
4706 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004707 priv->status |= STATUS_SCAN_FORCED;
David Howellsc4028952006-11-22 14:57:56 +00004708 queue_delayed_work(priv->workqueue,
4709 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05004710 break;
4711 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004712 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004713#endif /* CONFIG_IPW2200_MONITOR */
4714
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004715 if (!(priv->status & (STATUS_ASSOCIATED |
4716 STATUS_ASSOCIATING |
4717 STATUS_ROAMING |
4718 STATUS_DISASSOCIATING)))
4719 queue_work(priv->workqueue, &priv->associate);
4720 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004721 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4722 /* If a scan completed and we are in roam mode, then
4723 * the scan that completed was the one requested as a
4724 * result of entering roam... so, schedule the
4725 * roam work */
4726 queue_work(priv->workqueue,
4727 &priv->roam);
4728 else
4729 /* Don't schedule if we aborted the scan */
4730 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004731 } else if (priv->status & STATUS_SCAN_PENDING)
David Howellsc4028952006-11-22 14:57:56 +00004732 queue_delayed_work(priv->workqueue,
4733 &priv->request_scan, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05004734 else if (priv->config & CFG_BACKGROUND_SCAN
4735 && priv->status & STATUS_ASSOCIATED)
4736 queue_delayed_work(priv->workqueue,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07004737 &priv->request_scan,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004738 round_jiffies_relative(HZ));
Zhu Yi07f02e42006-04-13 17:19:25 +08004739
4740 /* Send an empty event to user space.
4741 * We don't send the received data on the event because
4742 * it would require us to do complex transcoding, and
4743 * we want to minimise the work done in the irq handler
4744 * Use a request to extract the data.
4745 * Also, we generate this even for any scan, regardless
4746 * on how the scan was initiated. User space can just
4747 * sync on periodic scan to get fresh data...
4748 * Jean II */
Dan Williams0b531672007-10-09 13:55:24 -04004749 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4750 handle_scan_event(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004751 break;
4752 }
4753
4754 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4755 struct notif_frag_length *x = &notif->u.frag_len;
4756
Al Viroe62e1ee2007-12-27 01:36:46 -05004757 if (size == sizeof(*x))
James Ketrenosa613bff2005-08-24 21:43:11 -05004758 IPW_ERROR("Frag length: %d\n",
4759 le16_to_cpu(x->frag_length));
4760 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004761 IPW_ERROR("Frag length of wrong size %d "
4762 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004763 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004764 break;
4765 }
4766
4767 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4768 struct notif_link_deterioration *x =
4769 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004770
Al Viroe62e1ee2007-12-27 01:36:46 -05004771 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004772 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004773 "link deterioration: type %d, cnt %d\n",
4774 x->silence_notification_type,
4775 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004776 memcpy(&priv->last_link_deterioration, x,
4777 sizeof(*x));
4778 } else {
4779 IPW_ERROR("Link Deterioration of wrong size %d "
4780 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004781 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004782 }
4783 break;
4784 }
4785
4786 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4787 IPW_ERROR("Dino config\n");
4788 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004789 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004790 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004791
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004792 break;
4793 }
4794
4795 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4796 struct notif_beacon_state *x = &notif->u.beacon_state;
Al Viroe62e1ee2007-12-27 01:36:46 -05004797 if (size != sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004798 IPW_ERROR
4799 ("Beacon state of wrong size %d (should "
Al Viroe62e1ee2007-12-27 01:36:46 -05004800 "be %zd)\n", size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004801 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004802 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004803
James Ketrenosa613bff2005-08-24 21:43:11 -05004804 if (le32_to_cpu(x->state) ==
4805 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4806 ipw_handle_missed_beacon(priv,
4807 le32_to_cpu(x->
4808 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004809
James Ketrenos43f66a62005-03-25 12:31:53 -06004810 break;
4811 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004812
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004813 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4814 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
Al Viroe62e1ee2007-12-27 01:36:46 -05004815 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004816 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4817 "0x%02x station %d\n",
4818 x->key_state, x->security_type,
4819 x->station_index);
4820 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004821 }
4822
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004823 IPW_ERROR
4824 ("TGi Tx Key of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004825 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004826 break;
4827 }
4828
4829 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4830 struct notif_calibration *x = &notif->u.calibration;
4831
Al Viroe62e1ee2007-12-27 01:36:46 -05004832 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004833 memcpy(&priv->calib, x, sizeof(*x));
4834 IPW_DEBUG_INFO("TODO: Calibration\n");
4835 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004836 }
4837
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004838 IPW_ERROR
4839 ("Calibration of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004840 size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004841 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004842 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004843
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004844 case HOST_NOTIFICATION_NOISE_STATS:{
Al Viroe62e1ee2007-12-27 01:36:46 -05004845 if (size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004846 priv->exp_avg_noise =
4847 exponential_average(priv->exp_avg_noise,
4848 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4849 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004850 break;
4851 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004852
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004853 IPW_ERROR
4854 ("Noise stat is wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004855 size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004856 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004857 }
4858
James Ketrenos43f66a62005-03-25 12:31:53 -06004859 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004860 IPW_DEBUG_NOTIF("Unknown notification: "
4861 "subtype=%d,flags=0x%2x,size=%d\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004862 notif->subtype, notif->flags, size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 }
4864}
4865
4866/**
4867 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004868 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004869 * @param priv
4870 * @return error code
4871 */
4872static int ipw_queue_reset(struct ipw_priv *priv)
4873{
4874 int rc = 0;
4875 /** @todo customize queue sizes */
4876 int nTx = 64, nTxCmd = 8;
4877 ipw_tx_queue_free(priv);
4878 /* Tx CMD queue */
4879 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004880 IPW_TX_CMD_QUEUE_READ_INDEX,
4881 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4882 IPW_TX_CMD_QUEUE_BD_BASE,
4883 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004884 if (rc) {
4885 IPW_ERROR("Tx Cmd queue init failed\n");
4886 goto error;
4887 }
4888 /* Tx queue(s) */
4889 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004890 IPW_TX_QUEUE_0_READ_INDEX,
4891 IPW_TX_QUEUE_0_WRITE_INDEX,
4892 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004893 if (rc) {
4894 IPW_ERROR("Tx 0 queue init failed\n");
4895 goto error;
4896 }
4897 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004898 IPW_TX_QUEUE_1_READ_INDEX,
4899 IPW_TX_QUEUE_1_WRITE_INDEX,
4900 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004901 if (rc) {
4902 IPW_ERROR("Tx 1 queue init failed\n");
4903 goto error;
4904 }
4905 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004906 IPW_TX_QUEUE_2_READ_INDEX,
4907 IPW_TX_QUEUE_2_WRITE_INDEX,
4908 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004909 if (rc) {
4910 IPW_ERROR("Tx 2 queue init failed\n");
4911 goto error;
4912 }
4913 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004914 IPW_TX_QUEUE_3_READ_INDEX,
4915 IPW_TX_QUEUE_3_WRITE_INDEX,
4916 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004917 if (rc) {
4918 IPW_ERROR("Tx 3 queue init failed\n");
4919 goto error;
4920 }
4921 /* statistics */
4922 priv->rx_bufs_min = 0;
4923 priv->rx_pend_max = 0;
4924 return rc;
4925
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004926 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004927 ipw_tx_queue_free(priv);
4928 return rc;
4929}
4930
4931/**
4932 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004933 *
Stefano Brivio8ff9d212008-01-12 23:12:26 +01004934 * When FW advances 'R' index, all entries between old and
James Ketrenos43f66a62005-03-25 12:31:53 -06004935 * new 'R' index need to be reclaimed. As result, some free space
4936 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004937 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004938 * @note Need to protect against garbage in 'R' index
4939 * @param priv
4940 * @param txq
4941 * @param qindex
4942 * @return Number of used entries remains in the queue
4943 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004944static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004945 struct clx2_tx_queue *txq, int qindex)
4946{
4947 u32 hw_tail;
4948 int used;
4949 struct clx2_queue *q = &txq->q;
4950
4951 hw_tail = ipw_read32(priv, q->reg_r);
4952 if (hw_tail >= q->n_bd) {
4953 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004954 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4955 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004956 goto done;
4957 }
4958 for (; q->last_used != hw_tail;
4959 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4960 ipw_queue_tx_free_tfd(priv, txq);
4961 priv->tx_packets++;
4962 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004963 done:
Dan Williams943dbef2008-02-14 17:49:41 -05004964 if ((ipw_tx_queue_space(q) > q->low_mark) &&
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004965 (qindex >= 0) &&
4966 (priv->status & STATUS_ASSOCIATED) && netif_running(priv->net_dev))
4967 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004968 used = q->first_empty - q->last_used;
4969 if (used < 0)
4970 used += q->n_bd;
4971
4972 return used;
4973}
4974
4975static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4976 int len, int sync)
4977{
4978 struct clx2_tx_queue *txq = &priv->txq_cmd;
4979 struct clx2_queue *q = &txq->q;
4980 struct tfd_frame *tfd;
4981
Dan Williams943dbef2008-02-14 17:49:41 -05004982 if (ipw_tx_queue_space(q) < (sync ? 1 : 2)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06004983 IPW_ERROR("No space for Tx\n");
4984 return -EBUSY;
4985 }
4986
4987 tfd = &txq->bd[q->first_empty];
4988 txq->txb[q->first_empty] = NULL;
4989
4990 memset(tfd, 0, sizeof(*tfd));
4991 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
4992 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
4993 priv->hcmd_seq++;
4994 tfd->u.cmd.index = hcmd;
4995 tfd->u.cmd.length = len;
4996 memcpy(tfd->u.cmd.payload, buf, len);
4997 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
4998 ipw_write32(priv, q->reg_w, q->first_empty);
4999 _ipw_read32(priv, 0x90);
5000
5001 return 0;
5002}
5003
Jeff Garzikbf794512005-07-31 13:07:26 -04005004/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005005 * Rx theory of operation
5006 *
5007 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05005008 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06005009 * 0 to 31
5010 *
5011 * Rx Queue Indexes
5012 * The host/firmware share two index registers for managing the Rx buffers.
5013 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005014 * The READ index maps to the first position that the firmware may be writing
5015 * to -- the driver can read up to (but not including) this position and get
5016 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06005017 * The READ index is managed by the firmware once the card is enabled.
5018 *
5019 * The WRITE index maps to the last position the driver has read from -- the
5020 * position preceding WRITE is the last slot the firmware can place a packet.
5021 *
5022 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04005023 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06005024 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005025 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06005026 * INDEX position, and WRITE to the last (READ - 1 wrapped)
5027 *
5028 * When the firmware places a packet in a buffer it will advance the READ index
5029 * and fire the RX interrupt. The driver can then query the READ index and
5030 * process as many packets as possible, moving the WRITE index forward as it
5031 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04005032 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005033 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04005034 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06005035 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04005036 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06005037 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
5038 * ipw->rxq is replenished and the READ INDEX is updated (updating the
5039 * 'processed' and 'read' driver indexes as well)
5040 * + A received packet is processed and handed to the kernel network stack,
5041 * detached from the ipw->rxq. The driver 'processed' index is updated.
5042 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04005043 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
5044 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06005045 * were enough free buffers and RX_STALLED is set it is cleared.
5046 *
5047 *
5048 * Driver sequence:
5049 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005050 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06005051 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
5052 * ipw_rx_queue_restock
5053 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
5054 * queue, updates firmware pointers, and updates
5055 * the WRITE index. If insufficient rx_free buffers
5056 * are available, schedules ipw_rx_queue_replenish
5057 *
5058 * -- enable interrupts --
5059 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04005060 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06005061 * Moves the packet buffer from queue to rx_used.
5062 * Calls ipw_rx_queue_restock to refill any empty
5063 * slots.
5064 * ...
5065 *
5066 */
5067
Jeff Garzikbf794512005-07-31 13:07:26 -04005068/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005069 * If there are slots in the RX queue that need to be restocked,
5070 * and we have free pre-allocated buffers, fill the ranks as much
5071 * as we can pulling from rx_free.
5072 *
5073 * This moves the 'write' index forward to catch up with 'processed', and
5074 * also updates the memory address in the firmware to reference the new
5075 * target buffer.
5076 */
5077static void ipw_rx_queue_restock(struct ipw_priv *priv)
5078{
5079 struct ipw_rx_queue *rxq = priv->rxq;
5080 struct list_head *element;
5081 struct ipw_rx_mem_buffer *rxb;
5082 unsigned long flags;
5083 int write;
5084
5085 spin_lock_irqsave(&rxq->lock, flags);
5086 write = rxq->write;
Dan Williams943dbef2008-02-14 17:49:41 -05005087 while ((ipw_rx_queue_space(rxq) > 0) && (rxq->free_count)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005088 element = rxq->rx_free.next;
5089 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
5090 list_del(element);
5091
James Ketrenosb095c382005-08-24 22:04:42 -05005092 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005093 rxb->dma_addr);
5094 rxq->queue[rxq->write] = rxb;
5095 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5096 rxq->free_count--;
5097 }
5098 spin_unlock_irqrestore(&rxq->lock, flags);
5099
Jeff Garzikbf794512005-07-31 13:07:26 -04005100 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005101 * refill it */
5102 if (rxq->free_count <= RX_LOW_WATERMARK)
5103 queue_work(priv->workqueue, &priv->rx_replenish);
5104
5105 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005106 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005107 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005108}
5109
5110/*
5111 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005112 * Also restock the Rx queue via ipw_rx_queue_restock.
5113 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005114 * This is called as a scheduled work item (except for during intialization)
5115 */
5116static void ipw_rx_queue_replenish(void *data)
5117{
5118 struct ipw_priv *priv = data;
5119 struct ipw_rx_queue *rxq = priv->rxq;
5120 struct list_head *element;
5121 struct ipw_rx_mem_buffer *rxb;
5122 unsigned long flags;
5123
5124 spin_lock_irqsave(&rxq->lock, flags);
5125 while (!list_empty(&rxq->rx_used)) {
5126 element = rxq->rx_used.next;
5127 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005128 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005129 if (!rxb->skb) {
5130 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5131 priv->net_dev->name);
5132 /* We don't reschedule replenish work here -- we will
5133 * call the restock method and if it still needs
5134 * more buffers it will schedule replenish */
5135 break;
5136 }
5137 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005138
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005139 rxb->dma_addr =
5140 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005141 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005142
James Ketrenos43f66a62005-03-25 12:31:53 -06005143 list_add_tail(&rxb->list, &rxq->rx_free);
5144 rxq->free_count++;
5145 }
5146 spin_unlock_irqrestore(&rxq->lock, flags);
5147
5148 ipw_rx_queue_restock(priv);
5149}
5150
David Howellsc4028952006-11-22 14:57:56 +00005151static void ipw_bg_rx_queue_replenish(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005152{
David Howellsc4028952006-11-22 14:57:56 +00005153 struct ipw_priv *priv =
5154 container_of(work, struct ipw_priv, rx_replenish);
Zhu Yi46441512006-01-24 16:37:59 +08005155 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00005156 ipw_rx_queue_replenish(priv);
Zhu Yi46441512006-01-24 16:37:59 +08005157 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005158}
5159
James Ketrenos43f66a62005-03-25 12:31:53 -06005160/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005161 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005162 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005163 * non NULL it is unmapped and freed
5164 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005165static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005166{
5167 int i;
5168
5169 if (!rxq)
5170 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005171
James Ketrenos43f66a62005-03-25 12:31:53 -06005172 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5173 if (rxq->pool[i].skb != NULL) {
5174 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005175 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005176 dev_kfree_skb(rxq->pool[i].skb);
5177 }
5178 }
5179
5180 kfree(rxq);
5181}
5182
5183static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5184{
5185 struct ipw_rx_queue *rxq;
5186 int i;
5187
Takisc75f4742005-12-01 01:41:45 -08005188 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005189 if (unlikely(!rxq)) {
5190 IPW_ERROR("memory allocation failed\n");
5191 return NULL;
5192 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005193 spin_lock_init(&rxq->lock);
5194 INIT_LIST_HEAD(&rxq->rx_free);
5195 INIT_LIST_HEAD(&rxq->rx_used);
5196
5197 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005198 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005199 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5200
5201 /* Set us so that we have processed and used all buffers, but have
5202 * not restocked the Rx queue with fresh buffers */
5203 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005204 rxq->free_count = 0;
5205
5206 return rxq;
5207}
5208
5209static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5210{
5211 rate &= ~IEEE80211_BASIC_RATE_MASK;
5212 if (ieee_mode == IEEE_A) {
5213 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005214 case IEEE80211_OFDM_RATE_6MB:
5215 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005216 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005217 case IEEE80211_OFDM_RATE_9MB:
5218 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005219 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005220 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005221 return priv->
5222 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005223 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005224 return priv->
5225 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005226 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005227 return priv->
5228 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005229 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005230 return priv->
5231 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005232 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005233 return priv->
5234 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005235 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005236 return priv->
5237 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005238 default:
5239 return 0;
5240 }
5241 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005242
James Ketrenos43f66a62005-03-25 12:31:53 -06005243 /* B and G mixed */
5244 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005245 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005246 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005247 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005248 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005249 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005250 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005251 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005252 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5253 }
5254
5255 /* If we are limited to B modulations, bail at this point */
5256 if (ieee_mode == IEEE_B)
5257 return 0;
5258
5259 /* G */
5260 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005261 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005262 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005263 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005264 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005265 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005266 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005267 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005268 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005269 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005270 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005271 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005272 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005273 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005274 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005275 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005276 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5277 }
5278
5279 return 0;
5280}
5281
Jeff Garzikbf794512005-07-31 13:07:26 -04005282static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005283 const struct ieee80211_network *network,
5284 struct ipw_supported_rates *rates)
5285{
5286 int num_rates, i;
5287
5288 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005289 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005290 rates->num_rates = 0;
5291 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005292 if (!ipw_is_rate_in_mask(priv, network->mode,
5293 network->rates[i])) {
5294
James Ketrenosea2b26e2005-08-24 21:25:16 -05005295 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005296 IPW_DEBUG_SCAN("Adding masked mandatory "
5297 "rate %02X\n",
5298 network->rates[i]);
5299 rates->supported_rates[rates->num_rates++] =
5300 network->rates[i];
5301 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005302 }
5303
James Ketrenos43f66a62005-03-25 12:31:53 -06005304 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5305 network->rates[i], priv->rates_mask);
5306 continue;
5307 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005308
James Ketrenos43f66a62005-03-25 12:31:53 -06005309 rates->supported_rates[rates->num_rates++] = network->rates[i];
5310 }
5311
James Ketrenosa613bff2005-08-24 21:43:11 -05005312 num_rates = min(network->rates_ex_len,
5313 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005314 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005315 if (!ipw_is_rate_in_mask(priv, network->mode,
5316 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005317 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005318 IPW_DEBUG_SCAN("Adding masked mandatory "
5319 "rate %02X\n",
5320 network->rates_ex[i]);
5321 rates->supported_rates[rates->num_rates++] =
5322 network->rates[i];
5323 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005324 }
5325
James Ketrenos43f66a62005-03-25 12:31:53 -06005326 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5327 network->rates_ex[i], priv->rates_mask);
5328 continue;
5329 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005330
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005331 rates->supported_rates[rates->num_rates++] =
5332 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005333 }
5334
James Ketrenosea2b26e2005-08-24 21:25:16 -05005335 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005336}
5337
Arjan van de Ven858119e2006-01-14 13:20:43 -08005338static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005339 const struct ipw_supported_rates *src)
5340{
5341 u8 i;
5342 for (i = 0; i < src->num_rates; i++)
5343 dest->supported_rates[i] = src->supported_rates[i];
5344 dest->num_rates = src->num_rates;
5345}
5346
5347/* TODO: Look at sniffed packets in the air to determine if the basic rate
5348 * mask should ever be used -- right now all callers to add the scan rates are
5349 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5350static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005351 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005352{
Jeff Garzikbf794512005-07-31 13:07:26 -04005353 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005354 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005355
James Ketrenos43f66a62005-03-25 12:31:53 -06005356 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005357 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005358 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005359
5360 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005361 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005362 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005363
5364 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005365 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005366 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005367
5368 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005369 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005370 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005371}
5372
5373static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005374 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005375{
Jeff Garzikbf794512005-07-31 13:07:26 -04005376 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005377 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005378
5379 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005380 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005381 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005382
5383 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005384 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005385 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005386
5387 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005388 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005389 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005390
5391 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005392 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005393 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005394
5395 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005396 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005397 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005398
5399 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005400 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005401 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005402
5403 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005404 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005405 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005406
5407 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005408 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005409 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005410}
5411
5412struct ipw_network_match {
5413 struct ieee80211_network *network;
5414 struct ipw_supported_rates rates;
5415};
5416
James Ketrenosc848d0a2005-08-24 21:56:24 -05005417static int ipw_find_adhoc_network(struct ipw_priv *priv,
5418 struct ipw_network_match *match,
5419 struct ieee80211_network *network,
5420 int roaming)
5421{
5422 struct ipw_supported_rates rates;
Joe Perches0795af52007-10-03 17:59:30 -07005423 DECLARE_MAC_BUF(mac);
5424 DECLARE_MAC_BUF(mac2);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005425
5426 /* Verify that this network's capability is compatible with the
5427 * current mode (AdHoc or Infrastructure) */
5428 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5429 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Joe Perches0795af52007-10-03 17:59:30 -07005430 IPW_DEBUG_MERGE("Network '%s (%s)' excluded due to "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005431 "capability mismatch.\n",
5432 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005433 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005434 return 0;
5435 }
5436
5437 /* If we do not have an ESSID for this AP, we can not associate with
5438 * it */
5439 if (network->flags & NETWORK_EMPTY_ESSID) {
Joe Perches0795af52007-10-03 17:59:30 -07005440 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005441 "because of hidden ESSID.\n",
5442 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005443 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005444 return 0;
5445 }
5446
5447 if (unlikely(roaming)) {
5448 /* If we are roaming, then ensure check if this is a valid
5449 * network to try and roam to */
5450 if ((network->ssid_len != match->network->ssid_len) ||
5451 memcmp(network->ssid, match->network->ssid,
5452 network->ssid_len)) {
Joe Perches0795af52007-10-03 17:59:30 -07005453 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005454 "because of non-network ESSID.\n",
5455 escape_essid(network->ssid,
5456 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005457 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005458 return 0;
5459 }
5460 } else {
5461 /* If an ESSID has been configured then compare the broadcast
5462 * ESSID to ours */
5463 if ((priv->config & CFG_STATIC_ESSID) &&
5464 ((network->ssid_len != priv->essid_len) ||
5465 memcmp(network->ssid, priv->essid,
5466 min(network->ssid_len, priv->essid_len)))) {
5467 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005468
James Ketrenosc848d0a2005-08-24 21:56:24 -05005469 strncpy(escaped,
5470 escape_essid(network->ssid, network->ssid_len),
5471 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005472 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005473 "because of ESSID mismatch: '%s'.\n",
Joe Perches0795af52007-10-03 17:59:30 -07005474 escaped, print_mac(mac, network->bssid),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005475 escape_essid(priv->essid,
5476 priv->essid_len));
5477 return 0;
5478 }
5479 }
5480
5481 /* If the old network rate is better than this one, don't bother
5482 * testing everything else. */
5483
5484 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005485 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5486 "current network.\n",
5487 escape_essid(match->network->ssid,
5488 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005489 return 0;
5490 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005491 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5492 "current network.\n",
5493 escape_essid(match->network->ssid,
5494 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005495 return 0;
5496 }
5497
5498 /* Now go through and see if the requested network is valid... */
5499 if (priv->ieee->scan_age != 0 &&
5500 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Joe Perches0795af52007-10-03 17:59:30 -07005501 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005502 "because of age: %ums.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005503 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005504 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005505 jiffies_to_msecs(jiffies -
5506 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005507 return 0;
5508 }
5509
5510 if ((priv->config & CFG_STATIC_CHANNEL) &&
5511 (network->channel != priv->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005512 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005513 "because of channel mismatch: %d != %d.\n",
5514 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005515 print_mac(mac, network->bssid),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005516 network->channel, priv->channel);
5517 return 0;
5518 }
5519
5520 /* Verify privacy compatability */
5521 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5522 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Joe Perches0795af52007-10-03 17:59:30 -07005523 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005524 "because of privacy mismatch: %s != %s.\n",
5525 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005526 print_mac(mac, network->bssid),
James Ketrenosafbf30a2005-08-25 00:05:33 -05005527 priv->
5528 capability & CAP_PRIVACY_ON ? "on" : "off",
5529 network->
5530 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5531 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005532 return 0;
5533 }
5534
5535 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Joe Perches0795af52007-10-03 17:59:30 -07005536 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
5537 "because of the same BSSID match: %s"
James Ketrenosc848d0a2005-08-24 21:56:24 -05005538 ".\n", escape_essid(network->ssid,
5539 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005540 print_mac(mac, network->bssid),
5541 print_mac(mac2, priv->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005542 return 0;
5543 }
5544
5545 /* Filter out any incompatible freq / mode combinations */
5546 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Joe Perches0795af52007-10-03 17:59:30 -07005547 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005548 "because of invalid frequency/mode "
5549 "combination.\n",
5550 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005551 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005552 return 0;
5553 }
5554
5555 /* Ensure that the rates supported by the driver are compatible with
5556 * this AP, including verification of basic rates (mandatory) */
5557 if (!ipw_compatible_rates(priv, network, &rates)) {
Joe Perches0795af52007-10-03 17:59:30 -07005558 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005559 "because configured rate mask excludes "
5560 "AP mandatory rate.\n",
5561 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005562 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005563 return 0;
5564 }
5565
5566 if (rates.num_rates == 0) {
Joe Perches0795af52007-10-03 17:59:30 -07005567 IPW_DEBUG_MERGE("Network '%s (%s)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005568 "because of no compatible rates.\n",
5569 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005570 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005571 return 0;
5572 }
5573
5574 /* TODO: Perform any further minimal comparititive tests. We do not
5575 * want to put too much policy logic here; intelligent scan selection
5576 * should occur within a generic IEEE 802.11 user space tool. */
5577
5578 /* Set up 'new' AP to this network */
5579 ipw_copy_rates(&match->rates, &rates);
5580 match->network = network;
Joe Perches0795af52007-10-03 17:59:30 -07005581 IPW_DEBUG_MERGE("Network '%s (%s)' is a viable match.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005582 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005583 print_mac(mac, network->bssid));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005584
5585 return 1;
5586}
5587
David Howellsc4028952006-11-22 14:57:56 +00005588static void ipw_merge_adhoc_network(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005589{
David Howellsc4028952006-11-22 14:57:56 +00005590 struct ipw_priv *priv =
5591 container_of(work, struct ipw_priv, merge_networks);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005592 struct ieee80211_network *network = NULL;
5593 struct ipw_network_match match = {
5594 .network = priv->assoc_network
5595 };
5596
James Ketrenosafbf30a2005-08-25 00:05:33 -05005597 if ((priv->status & STATUS_ASSOCIATED) &&
5598 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005599 /* First pass through ROAM process -- look for a better
5600 * network */
5601 unsigned long flags;
5602
5603 spin_lock_irqsave(&priv->ieee->lock, flags);
5604 list_for_each_entry(network, &priv->ieee->network_list, list) {
5605 if (network != priv->assoc_network)
5606 ipw_find_adhoc_network(priv, &match, network,
5607 1);
5608 }
5609 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5610
5611 if (match.network == priv->assoc_network) {
5612 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5613 "merge to.\n");
5614 return;
5615 }
5616
Zhu Yi46441512006-01-24 16:37:59 +08005617 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005618 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5619 IPW_DEBUG_MERGE("remove network %s\n",
5620 escape_essid(priv->essid,
5621 priv->essid_len));
5622 ipw_remove_current_network(priv);
5623 }
5624
5625 ipw_disassociate(priv);
5626 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005627 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005628 return;
5629 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005630}
5631
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005632static int ipw_best_network(struct ipw_priv *priv,
5633 struct ipw_network_match *match,
5634 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005635{
5636 struct ipw_supported_rates rates;
Joe Perches0795af52007-10-03 17:59:30 -07005637 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06005638
5639 /* Verify that this network's capability is compatible with the
5640 * current mode (AdHoc or Infrastructure) */
5641 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005642 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005643 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5644 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Joe Perches0795af52007-10-03 17:59:30 -07005645 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005646 "capability mismatch.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005647 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005648 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005649 return 0;
5650 }
5651
5652 /* If we do not have an ESSID for this AP, we can not associate with
5653 * it */
5654 if (network->flags & NETWORK_EMPTY_ESSID) {
Joe Perches0795af52007-10-03 17:59:30 -07005655 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005656 "because of hidden ESSID.\n",
5657 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005658 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005659 return 0;
5660 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005661
James Ketrenos43f66a62005-03-25 12:31:53 -06005662 if (unlikely(roaming)) {
5663 /* If we are roaming, then ensure check if this is a valid
5664 * network to try and roam to */
5665 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005666 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005667 network->ssid_len)) {
Joe Perches0795af52007-10-03 17:59:30 -07005668 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005669 "because of non-network ESSID.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04005670 escape_essid(network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005671 network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005672 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005673 return 0;
5674 }
5675 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005676 /* If an ESSID has been configured then compare the broadcast
5677 * ESSID to ours */
5678 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005679 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005680 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005681 min(network->ssid_len, priv->essid_len)))) {
5682 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005683 strncpy(escaped,
5684 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005685 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005686 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005687 "because of ESSID mismatch: '%s'.\n",
Joe Perches0795af52007-10-03 17:59:30 -07005688 escaped, print_mac(mac, network->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005689 escape_essid(priv->essid,
5690 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005691 return 0;
5692 }
5693 }
5694
5695 /* If the old network rate is better than this one, don't bother
5696 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005697 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005698 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005699 strncpy(escaped,
5700 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005701 sizeof(escaped));
Joe Perches0795af52007-10-03 17:59:30 -07005702 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded because "
5703 "'%s (%s)' has a stronger signal.\n",
5704 escaped, print_mac(mac, network->bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06005705 escape_essid(match->network->ssid,
5706 match->network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005707 print_mac(mac, match->network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005708 return 0;
5709 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005710
James Ketrenos43f66a62005-03-25 12:31:53 -06005711 /* If this network has already had an association attempt within the
5712 * last 3 seconds, do not try and associate again... */
5713 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005714 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
Joe Perches0795af52007-10-03 17:59:30 -07005715 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005716 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005717 "assoc attempt).\n",
5718 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005719 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005720 jiffies_to_msecs(jiffies -
5721 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005722 return 0;
5723 }
5724
5725 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005726 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005727 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Joe Perches0795af52007-10-03 17:59:30 -07005728 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005729 "because of age: %ums.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005730 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005731 print_mac(mac, network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005732 jiffies_to_msecs(jiffies -
5733 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005734 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005735 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005736
Jeff Garzikbf794512005-07-31 13:07:26 -04005737 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005738 (network->channel != priv->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005739 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005740 "because of channel mismatch: %d != %d.\n",
5741 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005742 print_mac(mac, network->bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06005743 network->channel, priv->channel);
5744 return 0;
5745 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005746
James Ketrenos43f66a62005-03-25 12:31:53 -06005747 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005748 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005749 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Joe Perches0795af52007-10-03 17:59:30 -07005750 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005751 "because of privacy mismatch: %s != %s.\n",
5752 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005753 print_mac(mac, network->bssid),
Jeff Garzikbf794512005-07-31 13:07:26 -04005754 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005755 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005756 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005757 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005758 return 0;
5759 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005760
5761 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005762 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Joe Perches0795af52007-10-03 17:59:30 -07005763 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
5764 "because of BSSID mismatch: %s.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005765 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005766 print_mac(mac, network->bssid), print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005767 return 0;
5768 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005769
James Ketrenos43f66a62005-03-25 12:31:53 -06005770 /* Filter out any incompatible freq / mode combinations */
5771 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Joe Perches0795af52007-10-03 17:59:30 -07005772 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005773 "because of invalid frequency/mode "
5774 "combination.\n",
5775 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005776 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005777 return 0;
5778 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005779
Liu Hong1fe0adb2005-08-19 09:33:10 -05005780 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005781 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Joe Perches0795af52007-10-03 17:59:30 -07005782 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
Liu Hong1fe0adb2005-08-19 09:33:10 -05005783 "because of invalid channel in current GEO\n",
5784 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005785 print_mac(mac, network->bssid));
Liu Hong1fe0adb2005-08-19 09:33:10 -05005786 return 0;
5787 }
5788
James Ketrenosea2b26e2005-08-24 21:25:16 -05005789 /* Ensure that the rates supported by the driver are compatible with
5790 * this AP, including verification of basic rates (mandatory) */
5791 if (!ipw_compatible_rates(priv, network, &rates)) {
Joe Perches0795af52007-10-03 17:59:30 -07005792 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenosea2b26e2005-08-24 21:25:16 -05005793 "because configured rate mask excludes "
5794 "AP mandatory rate.\n",
5795 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005796 print_mac(mac, network->bssid));
James Ketrenosea2b26e2005-08-24 21:25:16 -05005797 return 0;
5798 }
5799
James Ketrenos43f66a62005-03-25 12:31:53 -06005800 if (rates.num_rates == 0) {
Joe Perches0795af52007-10-03 17:59:30 -07005801 IPW_DEBUG_ASSOC("Network '%s (%s)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005802 "because of no compatible rates.\n",
5803 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005804 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005805 return 0;
5806 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005807
James Ketrenos43f66a62005-03-25 12:31:53 -06005808 /* TODO: Perform any further minimal comparititive tests. We do not
5809 * want to put too much policy logic here; intelligent scan selection
5810 * should occur within a generic IEEE 802.11 user space tool. */
5811
5812 /* Set up 'new' AP to this network */
5813 ipw_copy_rates(&match->rates, &rates);
5814 match->network = network;
5815
Joe Perches0795af52007-10-03 17:59:30 -07005816 IPW_DEBUG_ASSOC("Network '%s (%s)' is a viable match.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005817 escape_essid(network->ssid, network->ssid_len),
Joe Perches0795af52007-10-03 17:59:30 -07005818 print_mac(mac, network->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005819
5820 return 1;
5821}
5822
Jeff Garzikbf794512005-07-31 13:07:26 -04005823static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005824 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005825{
Larry Finger1867b112006-02-28 09:48:28 -06005826 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005827 int i;
5828
James Ketrenos43f66a62005-03-25 12:31:53 -06005829 /*
5830 * For the purposes of scanning, we can set our wireless mode
5831 * to trigger scans across combinations of bands, but when it
5832 * comes to creating a new ad-hoc network, we have tell the FW
5833 * exactly which band to use.
5834 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005835 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005836 * chossen band. Attempting to create a new ad-hoc network
5837 * with an invalid channel for wireless mode will trigger a
5838 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005839 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005840 */
Larry Finger1867b112006-02-28 09:48:28 -06005841 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005842 case IEEE80211_52GHZ_BAND:
5843 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005844 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005845 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005846 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5847 IPW_WARNING("Overriding invalid channel\n");
5848 priv->channel = geo->a[0].channel;
5849 }
5850 break;
5851
5852 case IEEE80211_24GHZ_BAND:
5853 if (priv->ieee->mode & IEEE_G)
5854 network->mode = IEEE_G;
5855 else
5856 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005857 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005858 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005859 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5860 IPW_WARNING("Overriding invalid channel\n");
5861 priv->channel = geo->bg[0].channel;
5862 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005863 break;
5864
5865 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005866 IPW_WARNING("Overriding invalid channel\n");
5867 if (priv->ieee->mode & IEEE_A) {
5868 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005869 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005870 } else if (priv->ieee->mode & IEEE_G) {
5871 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005872 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005873 } else {
5874 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005875 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005876 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005877 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005878 }
5879
5880 network->channel = priv->channel;
5881 priv->config |= CFG_ADHOC_PERSIST;
5882 ipw_create_bssid(priv, network->bssid);
5883 network->ssid_len = priv->essid_len;
5884 memcpy(network->ssid, priv->essid, priv->essid_len);
5885 memset(&network->stats, 0, sizeof(network->stats));
5886 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005887 if (!(priv->config & CFG_PREAMBLE_LONG))
5888 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005889 if (priv->capability & CAP_PRIVACY_ON)
5890 network->capability |= WLAN_CAPABILITY_PRIVACY;
5891 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005892 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005893 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005894 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005895 &priv->rates.supported_rates[network->rates_len],
5896 network->rates_ex_len);
5897 network->last_scanned = 0;
5898 network->flags = 0;
5899 network->last_associate = 0;
5900 network->time_stamp[0] = 0;
5901 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005902 network->beacon_interval = 100; /* Default */
5903 network->listen_interval = 10; /* Default */
5904 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005905 network->wpa_ie_len = 0;
5906 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005907}
5908
James Ketrenosb095c382005-08-24 22:04:42 -05005909static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5910{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005911 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005912
5913 if (!(priv->ieee->sec.flags & (1 << index)))
5914 return;
5915
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005916 key.key_id = index;
5917 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5918 key.security_type = type;
5919 key.station_index = 0; /* always 0 for BSS */
5920 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005921 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005922 key.tx_counter[0] = cpu_to_le32(0);
5923 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005924
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005925 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005926}
5927
5928static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005929{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005930 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005931 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005932
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005933 key.cmd_id = DINO_CMD_WEP_KEY;
5934 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005935
James Ketrenosb095c382005-08-24 22:04:42 -05005936 /* Note: AES keys cannot be set for multiple times.
5937 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005938 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005939 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005940 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005941 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005942 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005943 }
5944
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005945 key.key_size = priv->ieee->sec.key_sizes[i];
5946 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005947
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005948 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005949 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005950}
5951
Zhu Yi1fbfea52005-08-05 17:22:56 +08005952static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5953{
5954 if (priv->ieee->host_encrypt)
5955 return;
5956
5957 switch (level) {
5958 case SEC_LEVEL_3:
5959 priv->sys_config.disable_unicast_decryption = 0;
5960 priv->ieee->host_decrypt = 0;
5961 break;
5962 case SEC_LEVEL_2:
5963 priv->sys_config.disable_unicast_decryption = 1;
5964 priv->ieee->host_decrypt = 1;
5965 break;
5966 case SEC_LEVEL_1:
5967 priv->sys_config.disable_unicast_decryption = 0;
5968 priv->ieee->host_decrypt = 0;
5969 break;
5970 case SEC_LEVEL_0:
5971 priv->sys_config.disable_unicast_decryption = 1;
5972 break;
5973 default:
5974 break;
5975 }
5976}
5977
5978static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5979{
5980 if (priv->ieee->host_encrypt)
5981 return;
5982
5983 switch (level) {
5984 case SEC_LEVEL_3:
5985 priv->sys_config.disable_multicast_decryption = 0;
5986 break;
5987 case SEC_LEVEL_2:
5988 priv->sys_config.disable_multicast_decryption = 1;
5989 break;
5990 case SEC_LEVEL_1:
5991 priv->sys_config.disable_multicast_decryption = 0;
5992 break;
5993 case SEC_LEVEL_0:
5994 priv->sys_config.disable_multicast_decryption = 1;
5995 break;
5996 default:
5997 break;
5998 }
5999}
6000
James Ketrenosb095c382005-08-24 22:04:42 -05006001static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
6002{
6003 switch (priv->ieee->sec.level) {
6004 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006005 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6006 ipw_send_tgi_tx_key(priv,
6007 DCT_FLAG_EXT_SECURITY_CCM,
6008 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006009
Hong Liu567deaf2005-08-31 18:07:22 +08006010 if (!priv->ieee->host_mc_decrypt)
6011 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05006012 break;
6013 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006014 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6015 ipw_send_tgi_tx_key(priv,
6016 DCT_FLAG_EXT_SECURITY_TKIP,
6017 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05006018 break;
6019 case SEC_LEVEL_1:
6020 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05006021 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
6022 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05006023 break;
6024 case SEC_LEVEL_0:
6025 default:
6026 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06006027 }
6028}
6029
6030static void ipw_adhoc_check(void *data)
6031{
6032 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04006033
James Ketrenosafbf30a2005-08-25 00:05:33 -05006034 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06006035 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006036 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
6037 IPW_DL_STATE | IPW_DL_ASSOC,
6038 "Missed beacon: %d - disassociate\n",
6039 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06006040 ipw_remove_current_network(priv);
6041 ipw_disassociate(priv);
6042 return;
6043 }
6044
Jeff Garzikbf794512005-07-31 13:07:26 -04006045 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05006046 le16_to_cpu(priv->assoc_request.beacon_interval));
James Ketrenos43f66a62005-03-25 12:31:53 -06006047}
6048
David Howellsc4028952006-11-22 14:57:56 +00006049static void ipw_bg_adhoc_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006050{
David Howellsc4028952006-11-22 14:57:56 +00006051 struct ipw_priv *priv =
6052 container_of(work, struct ipw_priv, adhoc_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08006053 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006054 ipw_adhoc_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006055 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006056}
6057
James Ketrenos43f66a62005-03-25 12:31:53 -06006058static void ipw_debug_config(struct ipw_priv *priv)
6059{
Joe Perches0795af52007-10-03 17:59:30 -07006060 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06006061 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
6062 "[CFG 0x%08X]\n", priv->config);
6063 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006064 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06006065 else
6066 IPW_DEBUG_INFO("Channel unlocked.\n");
6067 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04006068 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006069 escape_essid(priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06006070 else
6071 IPW_DEBUG_INFO("ESSID unlocked.\n");
6072 if (priv->config & CFG_STATIC_BSSID)
Joe Perches0795af52007-10-03 17:59:30 -07006073 IPW_DEBUG_INFO("BSSID locked to %s\n",
6074 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06006075 else
6076 IPW_DEBUG_INFO("BSSID unlocked.\n");
6077 if (priv->capability & CAP_PRIVACY_ON)
6078 IPW_DEBUG_INFO("PRIVACY on\n");
6079 else
6080 IPW_DEBUG_INFO("PRIVACY off\n");
6081 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
6082}
James Ketrenos43f66a62005-03-25 12:31:53 -06006083
Arjan van de Ven858119e2006-01-14 13:20:43 -08006084static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06006085{
6086 /* TODO: Verify that this works... */
6087 struct ipw_fixed_rate fr = {
6088 .tx_rates = priv->rates_mask
6089 };
6090 u32 reg;
6091 u16 mask = 0;
6092
Jeff Garzikbf794512005-07-31 13:07:26 -04006093 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06006094 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04006095
James Ketrenos43f66a62005-03-25 12:31:53 -06006096 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006097 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06006098 /* IEEE_A */
6099 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6100 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006101 IPW_DEBUG_WX
6102 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006103 fr.tx_rates = 0;
6104 break;
6105 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006106
James Ketrenos43f66a62005-03-25 12:31:53 -06006107 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6108 break;
6109
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006110 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006111 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006112 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006113 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6114 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006115 IPW_DEBUG_WX
6116 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006117 fr.tx_rates = 0;
6118 }
6119 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006120 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006121
6122 /* IEEE_G */
6123 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6124 IEEE80211_OFDM_RATES_MASK)) {
6125 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006126 IPW_DEBUG_WX
6127 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006128 fr.tx_rates = 0;
6129 break;
6130 }
6131
6132 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6133 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6134 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6135 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006136
James Ketrenos43f66a62005-03-25 12:31:53 -06006137 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6138 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6139 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6140 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006141
James Ketrenos43f66a62005-03-25 12:31:53 -06006142 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6143 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6144 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6145 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006146
James Ketrenos43f66a62005-03-25 12:31:53 -06006147 fr.tx_rates |= mask;
6148 break;
6149 }
6150
6151 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006152 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006153}
6154
James Ketrenosea2b26e2005-08-24 21:25:16 -05006155static void ipw_abort_scan(struct ipw_priv *priv)
6156{
6157 int err;
6158
6159 if (priv->status & STATUS_SCAN_ABORTING) {
6160 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6161 return;
6162 }
6163 priv->status |= STATUS_SCAN_ABORTING;
6164
6165 err = ipw_send_scan_abort(priv);
6166 if (err)
6167 IPW_DEBUG_HC("Request to abort scan failed.\n");
6168}
6169
James Ketrenosafbf30a2005-08-25 00:05:33 -05006170static void ipw_add_scan_channels(struct ipw_priv *priv,
6171 struct ipw_scan_request_ext *scan,
6172 int scan_type)
6173{
6174 int channel_index = 0;
6175 const struct ieee80211_geo *geo;
6176 int i;
6177
Larry Finger1867b112006-02-28 09:48:28 -06006178 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006179
6180 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6181 int start = channel_index;
6182 for (i = 0; i < geo->a_channels; i++) {
6183 if ((priv->status & STATUS_ASSOCIATED) &&
6184 geo->a[i].channel == priv->channel)
6185 continue;
6186 channel_index++;
6187 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006188 ipw_set_scan_type(scan, channel_index,
6189 geo->a[i].
6190 flags & IEEE80211_CH_PASSIVE_ONLY ?
6191 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6192 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006193 }
6194
6195 if (start != channel_index) {
6196 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6197 (channel_index - start);
6198 channel_index++;
6199 }
6200 }
6201
6202 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6203 int start = channel_index;
6204 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006205 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006206 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6207 /* nop out the list */
6208 [0] = 0
6209 };
6210
6211 u8 channel;
6212 while (channel_index < IPW_SCAN_CHANNELS) {
6213 channel =
6214 priv->speed_scan[priv->speed_scan_pos];
6215 if (channel == 0) {
6216 priv->speed_scan_pos = 0;
6217 channel = priv->speed_scan[0];
6218 }
6219 if ((priv->status & STATUS_ASSOCIATED) &&
6220 channel == priv->channel) {
6221 priv->speed_scan_pos++;
6222 continue;
6223 }
6224
6225 /* If this channel has already been
6226 * added in scan, break from loop
6227 * and this will be the first channel
6228 * in the next scan.
6229 */
6230 if (channels[channel - 1] != 0)
6231 break;
6232
6233 channels[channel - 1] = 1;
6234 priv->speed_scan_pos++;
6235 channel_index++;
6236 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006237 index =
Larry Finger1867b112006-02-28 09:48:28 -06006238 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006239 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006240 geo->bg[index].
6241 flags &
6242 IEEE80211_CH_PASSIVE_ONLY ?
6243 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6244 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006245 }
6246 } else {
6247 for (i = 0; i < geo->bg_channels; i++) {
6248 if ((priv->status & STATUS_ASSOCIATED) &&
6249 geo->bg[i].channel == priv->channel)
6250 continue;
6251 channel_index++;
6252 scan->channels_list[channel_index] =
6253 geo->bg[i].channel;
6254 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006255 geo->bg[i].
6256 flags &
6257 IEEE80211_CH_PASSIVE_ONLY ?
6258 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6259 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006260 }
6261 }
6262
6263 if (start != channel_index) {
6264 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6265 (channel_index - start);
6266 }
6267 }
6268}
6269
Zhu Yi094c4d22006-08-21 11:39:03 +08006270static int ipw_request_scan_helper(struct ipw_priv *priv, int type)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006271{
6272 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006273 int err = 0, scan_type;
6274
6275 if (!(priv->status & STATUS_INIT) ||
6276 (priv->status & STATUS_EXIT_PENDING))
6277 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006278
Zhu Yi46441512006-01-24 16:37:59 +08006279 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006280
James Ketrenosea2b26e2005-08-24 21:25:16 -05006281 if (priv->status & STATUS_SCANNING) {
James Ketrenosa613bff2005-08-24 21:43:11 -05006282 IPW_DEBUG_HC("Concurrent scan requested. Ignoring.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05006283 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006284 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006285 }
6286
James Ketrenosafbf30a2005-08-25 00:05:33 -05006287 if (!(priv->status & STATUS_SCAN_FORCED) &&
6288 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006289 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
6290 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006291 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006292 }
6293
6294 if (priv->status & STATUS_RF_KILL_MASK) {
6295 IPW_DEBUG_HC("Aborting scan due to RF Kill activation\n");
6296 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006297 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006298 }
6299
6300 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006301 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006302
Zhu Yi094c4d22006-08-21 11:39:03 +08006303 if (type == IW_SCAN_TYPE_PASSIVE) {
6304 IPW_DEBUG_WX("use passive scanning\n");
6305 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
6306 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6307 cpu_to_le16(120);
6308 ipw_add_scan_channels(priv, &scan, scan_type);
6309 goto send_request;
6310 }
6311
6312 /* Use active scan by default. */
6313 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006314 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006315 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006316 else
6317 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006318 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006319
James Ketrenosa613bff2005-08-24 21:43:11 -05006320 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006321 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006322
Zhu Yi094c4d22006-08-21 11:39:03 +08006323 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006324
James Ketrenosb095c382005-08-24 22:04:42 -05006325#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006326 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006327 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006328 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006329
Larry Finger1867b112006-02-28 09:48:28 -06006330 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006331 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006332 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006333 channel = priv->channel;
6334 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006335
James Ketrenosb095c382005-08-24 22:04:42 -05006336 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006337 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006338 channel = priv->channel;
6339 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006340
James Ketrenosb095c382005-08-24 22:04:42 -05006341 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006342 band = (u8) (IPW_B_MODE << 6) | 1;
6343 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006344 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006345 }
6346
James Ketrenosb095c382005-08-24 22:04:42 -05006347 scan.channels_list[0] = band;
6348 scan.channels_list[1] = channel;
6349 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006350
James Ketrenosb095c382005-08-24 22:04:42 -05006351 /* NOTE: The card will sit on this channel for this time
6352 * period. Scan aborts are timing sensitive and frequently
6353 * result in firmware restarts. As such, it is best to
6354 * set a small dwell_time here and just keep re-issuing
6355 * scans. Otherwise fast channel hopping will not actually
6356 * hop channels.
6357 *
6358 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006359 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006360 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006361 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006362#endif /* CONFIG_IPW2200_MONITOR */
6363 /* If we are roaming, then make this a directed scan for the
6364 * current network. Otherwise, ensure that every other scan
6365 * is a fast channel hop scan */
6366 if ((priv->status & STATUS_ROAMING)
6367 || (!(priv->status & STATUS_ASSOCIATED)
6368 && (priv->config & CFG_STATIC_ESSID)
6369 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006370 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6371 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006372 IPW_DEBUG_HC("Attempt to send SSID command "
6373 "failed.\n");
6374 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006375 }
6376
6377 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006378 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006379 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006380
James Ketrenosafbf30a2005-08-25 00:05:33 -05006381 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006382#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006383 }
6384#endif
6385
Zhu Yi094c4d22006-08-21 11:39:03 +08006386send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006387 err = ipw_send_scan_request_ext(priv, &scan);
6388 if (err) {
6389 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006390 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006391 }
6392
6393 priv->status |= STATUS_SCANNING;
6394 priv->status &= ~STATUS_SCAN_PENDING;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006395 queue_delayed_work(priv->workqueue, &priv->scan_check,
6396 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006397done:
Zhu Yi46441512006-01-24 16:37:59 +08006398 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006399 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006400}
6401
David Howellsc4028952006-11-22 14:57:56 +00006402static void ipw_request_passive_scan(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006403{
David Howellsc4028952006-11-22 14:57:56 +00006404 struct ipw_priv *priv =
6405 container_of(work, struct ipw_priv, request_passive_scan);
6406 ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE);
6407}
6408
6409static void ipw_request_scan(struct work_struct *work)
6410{
6411 struct ipw_priv *priv =
6412 container_of(work, struct ipw_priv, request_scan.work);
6413 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE);
6414}
6415
6416static void ipw_bg_abort_scan(struct work_struct *work)
6417{
6418 struct ipw_priv *priv =
6419 container_of(work, struct ipw_priv, abort_scan);
Zhu Yi46441512006-01-24 16:37:59 +08006420 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006421 ipw_abort_scan(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006422 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006423}
6424
James Ketrenosea2b26e2005-08-24 21:25:16 -05006425static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6426{
James Ketrenosb095c382005-08-24 22:04:42 -05006427 /* This is called when wpa_supplicant loads and closes the driver
6428 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006429 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006430 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006431}
6432
James Ketrenosea2b26e2005-08-24 21:25:16 -05006433static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6434{
6435 struct ieee80211_device *ieee = priv->ieee;
6436 struct ieee80211_security sec = {
6437 .flags = SEC_AUTH_MODE,
6438 };
6439 int ret = 0;
6440
James Ketrenosafbf30a2005-08-25 00:05:33 -05006441 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006442 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6443 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006444 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006445 sec.auth_mode = WLAN_AUTH_OPEN;
6446 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006447 } else if (value & IW_AUTH_ALG_LEAP) {
6448 sec.auth_mode = WLAN_AUTH_LEAP;
6449 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006450 } else
6451 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006452
6453 if (ieee->set_security)
6454 ieee->set_security(ieee->dev, &sec);
6455 else
6456 ret = -EOPNOTSUPP;
6457
6458 return ret;
6459}
6460
Adrian Bunka73e22b2006-01-21 01:39:42 +01006461static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6462 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006463{
6464 /* make sure WPA is enabled */
6465 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006466}
6467
6468static int ipw_set_rsn_capa(struct ipw_priv *priv,
6469 char *capabilities, int length)
6470{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006471 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6472
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006473 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006474 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006475}
6476
James Ketrenosafbf30a2005-08-25 00:05:33 -05006477/*
6478 * WE-18 support
6479 */
6480
6481/* SIOCSIWGENIE */
6482static int ipw_wx_set_genie(struct net_device *dev,
6483 struct iw_request_info *info,
6484 union iwreq_data *wrqu, char *extra)
6485{
6486 struct ipw_priv *priv = ieee80211_priv(dev);
6487 struct ieee80211_device *ieee = priv->ieee;
6488 u8 *buf;
6489 int err = 0;
6490
6491 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6492 (wrqu->data.length && extra == NULL))
6493 return -EINVAL;
6494
James Ketrenosafbf30a2005-08-25 00:05:33 -05006495 if (wrqu->data.length) {
6496 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6497 if (buf == NULL) {
6498 err = -ENOMEM;
6499 goto out;
6500 }
6501
6502 memcpy(buf, extra, wrqu->data.length);
6503 kfree(ieee->wpa_ie);
6504 ieee->wpa_ie = buf;
6505 ieee->wpa_ie_len = wrqu->data.length;
6506 } else {
6507 kfree(ieee->wpa_ie);
6508 ieee->wpa_ie = NULL;
6509 ieee->wpa_ie_len = 0;
6510 }
6511
6512 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6513 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006514 return err;
6515}
6516
6517/* SIOCGIWGENIE */
6518static int ipw_wx_get_genie(struct net_device *dev,
6519 struct iw_request_info *info,
6520 union iwreq_data *wrqu, char *extra)
6521{
6522 struct ipw_priv *priv = ieee80211_priv(dev);
6523 struct ieee80211_device *ieee = priv->ieee;
6524 int err = 0;
6525
James Ketrenosafbf30a2005-08-25 00:05:33 -05006526 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6527 wrqu->data.length = 0;
6528 goto out;
6529 }
6530
6531 if (wrqu->data.length < ieee->wpa_ie_len) {
6532 err = -E2BIG;
6533 goto out;
6534 }
6535
6536 wrqu->data.length = ieee->wpa_ie_len;
6537 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6538
6539 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006540 return err;
6541}
6542
Zhu Yi1fbfea52005-08-05 17:22:56 +08006543static int wext_cipher2level(int cipher)
6544{
6545 switch (cipher) {
6546 case IW_AUTH_CIPHER_NONE:
6547 return SEC_LEVEL_0;
6548 case IW_AUTH_CIPHER_WEP40:
6549 case IW_AUTH_CIPHER_WEP104:
6550 return SEC_LEVEL_1;
6551 case IW_AUTH_CIPHER_TKIP:
6552 return SEC_LEVEL_2;
6553 case IW_AUTH_CIPHER_CCMP:
6554 return SEC_LEVEL_3;
6555 default:
6556 return -1;
6557 }
6558}
6559
James Ketrenosafbf30a2005-08-25 00:05:33 -05006560/* SIOCSIWAUTH */
6561static int ipw_wx_set_auth(struct net_device *dev,
6562 struct iw_request_info *info,
6563 union iwreq_data *wrqu, char *extra)
6564{
6565 struct ipw_priv *priv = ieee80211_priv(dev);
6566 struct ieee80211_device *ieee = priv->ieee;
6567 struct iw_param *param = &wrqu->param;
6568 struct ieee80211_crypt_data *crypt;
6569 unsigned long flags;
6570 int ret = 0;
6571
6572 switch (param->flags & IW_AUTH_INDEX) {
6573 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006574 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006575 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006576 ipw_set_hw_decrypt_unicast(priv,
6577 wext_cipher2level(param->value));
6578 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006579 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006580 ipw_set_hw_decrypt_multicast(priv,
6581 wext_cipher2level(param->value));
6582 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006583 case IW_AUTH_KEY_MGMT:
6584 /*
6585 * ipw2200 does not use these parameters
6586 */
6587 break;
6588
6589 case IW_AUTH_TKIP_COUNTERMEASURES:
6590 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006591 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006592 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006593
6594 flags = crypt->ops->get_flags(crypt->priv);
6595
6596 if (param->value)
6597 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6598 else
6599 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6600
6601 crypt->ops->set_flags(flags, crypt->priv);
6602
6603 break;
6604
6605 case IW_AUTH_DROP_UNENCRYPTED:{
6606 /* HACK:
6607 *
6608 * wpa_supplicant calls set_wpa_enabled when the driver
6609 * is loaded and unloaded, regardless of if WPA is being
6610 * used. No other calls are made which can be used to
6611 * determine if encryption will be used or not prior to
6612 * association being expected. If encryption is not being
6613 * used, drop_unencrypted is set to false, else true -- we
6614 * can use this to determine if the CAP_PRIVACY_ON bit should
6615 * be set.
6616 */
6617 struct ieee80211_security sec = {
6618 .flags = SEC_ENABLED,
6619 .enabled = param->value,
6620 };
6621 priv->ieee->drop_unencrypted = param->value;
6622 /* We only change SEC_LEVEL for open mode. Others
6623 * are set by ipw_wpa_set_encryption.
6624 */
6625 if (!param->value) {
6626 sec.flags |= SEC_LEVEL;
6627 sec.level = SEC_LEVEL_0;
6628 } else {
6629 sec.flags |= SEC_LEVEL;
6630 sec.level = SEC_LEVEL_1;
6631 }
6632 if (priv->ieee->set_security)
6633 priv->ieee->set_security(priv->ieee->dev, &sec);
6634 break;
6635 }
6636
6637 case IW_AUTH_80211_AUTH_ALG:
6638 ret = ipw_wpa_set_auth_algs(priv, param->value);
6639 break;
6640
6641 case IW_AUTH_WPA_ENABLED:
6642 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006643 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006644 break;
6645
6646 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6647 ieee->ieee802_1x = param->value;
6648 break;
6649
James Ketrenosafbf30a2005-08-25 00:05:33 -05006650 case IW_AUTH_PRIVACY_INVOKED:
6651 ieee->privacy_invoked = param->value;
6652 break;
6653
6654 default:
6655 return -EOPNOTSUPP;
6656 }
6657 return ret;
6658}
6659
6660/* SIOCGIWAUTH */
6661static int ipw_wx_get_auth(struct net_device *dev,
6662 struct iw_request_info *info,
6663 union iwreq_data *wrqu, char *extra)
6664{
6665 struct ipw_priv *priv = ieee80211_priv(dev);
6666 struct ieee80211_device *ieee = priv->ieee;
6667 struct ieee80211_crypt_data *crypt;
6668 struct iw_param *param = &wrqu->param;
6669 int ret = 0;
6670
6671 switch (param->flags & IW_AUTH_INDEX) {
6672 case IW_AUTH_WPA_VERSION:
6673 case IW_AUTH_CIPHER_PAIRWISE:
6674 case IW_AUTH_CIPHER_GROUP:
6675 case IW_AUTH_KEY_MGMT:
6676 /*
6677 * wpa_supplicant will control these internally
6678 */
6679 ret = -EOPNOTSUPP;
6680 break;
6681
6682 case IW_AUTH_TKIP_COUNTERMEASURES:
6683 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006684 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006685 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006686
6687 param->value = (crypt->ops->get_flags(crypt->priv) &
6688 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6689
6690 break;
6691
6692 case IW_AUTH_DROP_UNENCRYPTED:
6693 param->value = ieee->drop_unencrypted;
6694 break;
6695
6696 case IW_AUTH_80211_AUTH_ALG:
6697 param->value = ieee->sec.auth_mode;
6698 break;
6699
6700 case IW_AUTH_WPA_ENABLED:
6701 param->value = ieee->wpa_enabled;
6702 break;
6703
6704 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6705 param->value = ieee->ieee802_1x;
6706 break;
6707
6708 case IW_AUTH_ROAMING_CONTROL:
6709 case IW_AUTH_PRIVACY_INVOKED:
6710 param->value = ieee->privacy_invoked;
6711 break;
6712
6713 default:
6714 return -EOPNOTSUPP;
6715 }
6716 return 0;
6717}
6718
6719/* SIOCSIWENCODEEXT */
6720static int ipw_wx_set_encodeext(struct net_device *dev,
6721 struct iw_request_info *info,
6722 union iwreq_data *wrqu, char *extra)
6723{
6724 struct ipw_priv *priv = ieee80211_priv(dev);
6725 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6726
6727 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006728 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006729 /* IPW HW can't build TKIP MIC,
6730 host decryption still needed */
6731 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6732 priv->ieee->host_mc_decrypt = 1;
6733 else {
6734 priv->ieee->host_encrypt = 0;
6735 priv->ieee->host_encrypt_msdu = 1;
6736 priv->ieee->host_decrypt = 1;
6737 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006738 } else {
6739 priv->ieee->host_encrypt = 0;
6740 priv->ieee->host_encrypt_msdu = 0;
6741 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006742 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006743 }
6744 }
6745
6746 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6747}
6748
6749/* SIOCGIWENCODEEXT */
6750static int ipw_wx_get_encodeext(struct net_device *dev,
6751 struct iw_request_info *info,
6752 union iwreq_data *wrqu, char *extra)
6753{
6754 struct ipw_priv *priv = ieee80211_priv(dev);
6755 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6756}
6757
6758/* SIOCSIWMLME */
6759static int ipw_wx_set_mlme(struct net_device *dev,
6760 struct iw_request_info *info,
6761 union iwreq_data *wrqu, char *extra)
6762{
6763 struct ipw_priv *priv = ieee80211_priv(dev);
6764 struct iw_mlme *mlme = (struct iw_mlme *)extra;
Al Viroe62e1ee2007-12-27 01:36:46 -05006765 __le16 reason;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006766
6767 reason = cpu_to_le16(mlme->reason_code);
6768
6769 switch (mlme->cmd) {
6770 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006771 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006772 break;
6773
6774 case IW_MLME_DISASSOC:
6775 ipw_disassociate(priv);
6776 break;
6777
6778 default:
6779 return -EOPNOTSUPP;
6780 }
6781 return 0;
6782}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006783
Zhu Yie43e3c12006-04-13 17:20:45 +08006784#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006785
6786/* QoS */
6787/*
6788* get the modulation type of the current network or
6789* the card current mode
6790*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006791static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006792{
6793 u8 mode = 0;
6794
6795 if (priv->status & STATUS_ASSOCIATED) {
6796 unsigned long flags;
6797
6798 spin_lock_irqsave(&priv->ieee->lock, flags);
6799 mode = priv->assoc_network->mode;
6800 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6801 } else {
6802 mode = priv->ieee->mode;
6803 }
6804 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6805 return mode;
6806}
6807
6808/*
6809* Handle management frame beacon and probe response
6810*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006811static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6812 int active_network,
6813 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006814{
6815 u32 size = sizeof(struct ieee80211_qos_parameters);
6816
James Ketrenosafbf30a2005-08-25 00:05:33 -05006817 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006818 network->qos_data.active = network->qos_data.supported;
6819
6820 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006821 if (active_network &&
6822 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006823 network->qos_data.active = network->qos_data.supported;
6824
6825 if ((network->qos_data.active == 1) && (active_network == 1) &&
6826 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6827 (network->qos_data.old_param_count !=
6828 network->qos_data.param_count)) {
6829 network->qos_data.old_param_count =
6830 network->qos_data.param_count;
6831 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006832 IPW_DEBUG_QOS("QoS parameters change call "
6833 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006834 }
6835 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006836 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6837 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006838 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006839 else
6840 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006841 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006842
James Ketrenosb095c382005-08-24 22:04:42 -05006843 if ((network->qos_data.active == 1) && (active_network == 1)) {
6844 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6845 schedule_work(&priv->qos_activate);
6846 }
6847
6848 network->qos_data.active = 0;
6849 network->qos_data.supported = 0;
6850 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006851 if ((priv->status & STATUS_ASSOCIATED) &&
6852 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6853 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
6854 if ((network->capability & WLAN_CAPABILITY_IBSS) &&
6855 !(network->flags & NETWORK_EMPTY_ESSID))
James Ketrenosb095c382005-08-24 22:04:42 -05006856 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006857 priv->assoc_network->ssid_len) &&
6858 !memcmp(network->ssid,
6859 priv->assoc_network->ssid,
6860 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006861 queue_work(priv->workqueue,
6862 &priv->merge_networks);
6863 }
James Ketrenosb095c382005-08-24 22:04:42 -05006864 }
6865
6866 return 0;
6867}
6868
6869/*
6870* This function set up the firmware to support QoS. It sends
6871* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6872*/
6873static int ipw_qos_activate(struct ipw_priv *priv,
6874 struct ieee80211_qos_data *qos_network_data)
6875{
6876 int err;
6877 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6878 struct ieee80211_qos_parameters *active_one = NULL;
6879 u32 size = sizeof(struct ieee80211_qos_parameters);
6880 u32 burst_duration;
6881 int i;
6882 u8 type;
6883
6884 type = ipw_qos_current_mode(priv);
6885
6886 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6887 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6888 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6889 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6890
6891 if (qos_network_data == NULL) {
6892 if (type == IEEE_B) {
6893 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6894 active_one = &def_parameters_CCK;
6895 } else
6896 active_one = &def_parameters_OFDM;
6897
James Ketrenosafbf30a2005-08-25 00:05:33 -05006898 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006899 burst_duration = ipw_qos_get_burst_duration(priv);
6900 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006901 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Al Viro8fffc152007-12-27 01:25:40 -05006902 cpu_to_le16(burst_duration);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006903 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006904 if (type == IEEE_B) {
6905 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6906 type);
6907 if (priv->qos_data.qos_enable == 0)
6908 active_one = &def_parameters_CCK;
6909 else
6910 active_one = priv->qos_data.def_qos_parm_CCK;
6911 } else {
6912 if (priv->qos_data.qos_enable == 0)
6913 active_one = &def_parameters_OFDM;
6914 else
6915 active_one = priv->qos_data.def_qos_parm_OFDM;
6916 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006917 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006918 } else {
6919 unsigned long flags;
6920 int active;
6921
6922 spin_lock_irqsave(&priv->ieee->lock, flags);
6923 active_one = &(qos_network_data->parameters);
6924 qos_network_data->old_param_count =
6925 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006926 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006927 active = qos_network_data->supported;
6928 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6929
6930 if (active == 0) {
6931 burst_duration = ipw_qos_get_burst_duration(priv);
6932 for (i = 0; i < QOS_QUEUE_NUM; i++)
6933 qos_parameters[QOS_PARAM_SET_ACTIVE].
Al Viro8fffc152007-12-27 01:25:40 -05006934 tx_op_limit[i] = cpu_to_le16(burst_duration);
James Ketrenosb095c382005-08-24 22:04:42 -05006935 }
6936 }
6937
6938 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05006939 err = ipw_send_qos_params_command(priv,
6940 (struct ieee80211_qos_parameters *)
6941 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05006942 if (err)
6943 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
6944
6945 return err;
6946}
6947
6948/*
6949* send IPW_CMD_WME_INFO to the firmware
6950*/
6951static int ipw_qos_set_info_element(struct ipw_priv *priv)
6952{
6953 int ret = 0;
6954 struct ieee80211_qos_information_element qos_info;
6955
6956 if (priv == NULL)
6957 return -1;
6958
6959 qos_info.elementID = QOS_ELEMENT_ID;
6960 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
6961
6962 qos_info.version = QOS_VERSION_1;
6963 qos_info.ac_info = 0;
6964
6965 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
6966 qos_info.qui_type = QOS_OUI_TYPE;
6967 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
6968
6969 ret = ipw_send_qos_info_command(priv, &qos_info);
6970 if (ret != 0) {
6971 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
6972 }
6973 return ret;
6974}
6975
6976/*
6977* Set the QoS parameter with the association request structure
6978*/
6979static int ipw_qos_association(struct ipw_priv *priv,
6980 struct ieee80211_network *network)
6981{
6982 int err = 0;
6983 struct ieee80211_qos_data *qos_data = NULL;
6984 struct ieee80211_qos_data ibss_data = {
6985 .supported = 1,
6986 .active = 1,
6987 };
6988
6989 switch (priv->ieee->iw_mode) {
6990 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02006991 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05006992
6993 qos_data = &ibss_data;
6994 break;
6995
6996 case IW_MODE_INFRA:
6997 qos_data = &network->qos_data;
6998 break;
6999
7000 default:
7001 BUG();
7002 break;
7003 }
7004
7005 err = ipw_qos_activate(priv, qos_data);
7006 if (err) {
7007 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
7008 return err;
7009 }
7010
7011 if (priv->qos_data.qos_enable && qos_data->supported) {
7012 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
7013 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
7014 return ipw_qos_set_info_element(priv);
7015 }
7016
7017 return 0;
7018}
7019
7020/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01007021* handling the beaconing responses. if we get different QoS setting
7022* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05007023* setting
7024*/
7025static int ipw_qos_association_resp(struct ipw_priv *priv,
7026 struct ieee80211_network *network)
7027{
7028 int ret = 0;
7029 unsigned long flags;
7030 u32 size = sizeof(struct ieee80211_qos_parameters);
7031 int set_qos_param = 0;
7032
James Ketrenosafbf30a2005-08-25 00:05:33 -05007033 if ((priv == NULL) || (network == NULL) ||
7034 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05007035 return ret;
7036
7037 if (!(priv->status & STATUS_ASSOCIATED))
7038 return ret;
7039
James Ketrenosafbf30a2005-08-25 00:05:33 -05007040 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05007041 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05007042
7043 spin_lock_irqsave(&priv->ieee->lock, flags);
7044 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007045 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05007046 sizeof(struct ieee80211_qos_data));
7047 priv->assoc_network->qos_data.active = 1;
7048 if ((network->qos_data.old_param_count !=
7049 network->qos_data.param_count)) {
7050 set_qos_param = 1;
7051 network->qos_data.old_param_count =
7052 network->qos_data.param_count;
7053 }
7054
7055 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007056 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
7057 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007058 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007059 else
7060 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007061 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05007062 priv->assoc_network->qos_data.active = 0;
7063 priv->assoc_network->qos_data.supported = 0;
7064 set_qos_param = 1;
7065 }
7066
7067 spin_unlock_irqrestore(&priv->ieee->lock, flags);
7068
7069 if (set_qos_param == 1)
7070 schedule_work(&priv->qos_activate);
7071
7072 return ret;
7073}
7074
7075static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
7076{
7077 u32 ret = 0;
7078
7079 if ((priv == NULL))
7080 return 0;
7081
James Ketrenosafbf30a2005-08-25 00:05:33 -05007082 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05007083 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007084 else
James Ketrenosb095c382005-08-24 22:04:42 -05007085 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007086
James Ketrenosb095c382005-08-24 22:04:42 -05007087 return ret;
7088}
7089
7090/*
7091* Initialize the setting of QoS global
7092*/
7093static void ipw_qos_init(struct ipw_priv *priv, int enable,
7094 int burst_enable, u32 burst_duration_CCK,
7095 u32 burst_duration_OFDM)
7096{
7097 priv->qos_data.qos_enable = enable;
7098
7099 if (priv->qos_data.qos_enable) {
7100 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7101 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7102 IPW_DEBUG_QOS("QoS is enabled\n");
7103 } else {
7104 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7105 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7106 IPW_DEBUG_QOS("QoS is not enabled\n");
7107 }
7108
7109 priv->qos_data.burst_enable = burst_enable;
7110
7111 if (burst_enable) {
7112 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7113 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7114 } else {
7115 priv->qos_data.burst_duration_CCK = 0;
7116 priv->qos_data.burst_duration_OFDM = 0;
7117 }
7118}
7119
7120/*
7121* map the packet priority to the right TX Queue
7122*/
7123static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7124{
7125 if (priority > 7 || !priv->qos_data.qos_enable)
7126 priority = 0;
7127
7128 return from_priority_to_tx_queue[priority] - 1;
7129}
7130
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007131static int ipw_is_qos_active(struct net_device *dev,
7132 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007133{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007134 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007135 struct ieee80211_qos_data *qos_data = NULL;
7136 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007137 u8 *daddr = skb->data + ETH_ALEN;
7138 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007139
7140 if (!(priv->status & STATUS_ASSOCIATED))
7141 return 0;
7142
7143 qos_data = &priv->assoc_network->qos_data;
7144
James Ketrenosb095c382005-08-24 22:04:42 -05007145 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7146 if (unicast == 0)
7147 qos_data->active = 0;
7148 else
7149 qos_data->active = qos_data->supported;
7150 }
James Ketrenosb095c382005-08-24 22:04:42 -05007151 active = qos_data->active;
7152 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007153 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7154 "unicast %d\n",
7155 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007156 if (active && priv->qos_data.qos_enable)
7157 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007158
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007159 return 0;
7160
7161}
7162/*
7163* add QoS parameter to the TX command
7164*/
7165static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7166 u16 priority,
7167 struct tfd_data *tfd)
7168{
7169 int tx_queue_id = 0;
7170
7171
7172 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7173 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7174
7175 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7176 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007177 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007178 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007179 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007180}
7181
7182/*
7183* background support to run QoS activate functionality
7184*/
David Howellsc4028952006-11-22 14:57:56 +00007185static void ipw_bg_qos_activate(struct work_struct *work)
James Ketrenosb095c382005-08-24 22:04:42 -05007186{
David Howellsc4028952006-11-22 14:57:56 +00007187 struct ipw_priv *priv =
7188 container_of(work, struct ipw_priv, qos_activate);
James Ketrenosb095c382005-08-24 22:04:42 -05007189
7190 if (priv == NULL)
7191 return;
7192
Zhu Yi46441512006-01-24 16:37:59 +08007193 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007194
7195 if (priv->status & STATUS_ASSOCIATED)
7196 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7197
Zhu Yi46441512006-01-24 16:37:59 +08007198 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007199}
7200
James Ketrenos3b9990c2005-08-19 13:18:55 -05007201static int ipw_handle_probe_response(struct net_device *dev,
7202 struct ieee80211_probe_response *resp,
7203 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007204{
7205 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007206 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7207 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007208
James Ketrenos3b9990c2005-08-19 13:18:55 -05007209 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007210
James Ketrenos3b9990c2005-08-19 13:18:55 -05007211 return 0;
7212}
James Ketrenosb095c382005-08-24 22:04:42 -05007213
James Ketrenos3b9990c2005-08-19 13:18:55 -05007214static int ipw_handle_beacon(struct net_device *dev,
7215 struct ieee80211_beacon *resp,
7216 struct ieee80211_network *network)
7217{
7218 struct ipw_priv *priv = ieee80211_priv(dev);
7219 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7220 (network == priv->assoc_network));
7221
7222 ipw_qos_handle_probe_response(priv, active_network, network);
7223
7224 return 0;
7225}
7226
7227static int ipw_handle_assoc_response(struct net_device *dev,
7228 struct ieee80211_assoc_response *resp,
7229 struct ieee80211_network *network)
7230{
7231 struct ipw_priv *priv = ieee80211_priv(dev);
7232 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007233 return 0;
7234}
7235
7236static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7237 *qos_param)
7238{
Zhu Yi4e226992006-01-24 16:37:36 +08007239 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7240 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007241}
7242
7243static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7244 *qos_param)
7245{
Zhu Yi4e226992006-01-24 16:37:36 +08007246 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7247 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007248}
7249
Zhu Yie43e3c12006-04-13 17:20:45 +08007250#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007251
James Ketrenos43f66a62005-03-25 12:31:53 -06007252static int ipw_associate_network(struct ipw_priv *priv,
7253 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007254 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007255{
7256 int err;
Joe Perches0795af52007-10-03 17:59:30 -07007257 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06007258
7259 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007260 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007261
7262 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007263 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007264 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007265 memcpy(priv->essid, network->ssid, priv->essid_len);
7266 }
7267
7268 network->last_associate = jiffies;
7269
7270 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7271 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007272 priv->assoc_request.auth_key = 0;
7273
James Ketrenos43f66a62005-03-25 12:31:53 -06007274 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007275 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007276 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007277 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7278
Zhu Yi1ba61e02006-02-15 13:00:55 +08007279 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007280 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007281
7282 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7283 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7284 priv->assoc_request.auth_type = AUTH_LEAP;
7285 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007286 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007287
James Ketrenosa613bff2005-08-24 21:43:11 -05007288 if (priv->ieee->wpa_ie_len) {
Al Viro5b5e8072007-12-27 01:54:06 -05007289 priv->assoc_request.policy_support = cpu_to_le16(0x02); /* RSN active */
James Ketrenosea2b26e2005-08-24 21:25:16 -05007290 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7291 priv->ieee->wpa_ie_len);
7292 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007293
Jeff Garzikbf794512005-07-31 13:07:26 -04007294 /*
7295 * It is valid for our ieee device to support multiple modes, but
7296 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007297 * just one mode.
7298 */
7299 if (network->mode & priv->ieee->mode & IEEE_A)
7300 priv->assoc_request.ieee_mode = IPW_A_MODE;
7301 else if (network->mode & priv->ieee->mode & IEEE_G)
7302 priv->assoc_request.ieee_mode = IPW_G_MODE;
7303 else if (network->mode & priv->ieee->mode & IEEE_B)
7304 priv->assoc_request.ieee_mode = IPW_B_MODE;
7305
Al Viro5b5e8072007-12-27 01:54:06 -05007306 priv->assoc_request.capability = cpu_to_le16(network->capability);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007307 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7308 && !(priv->config & CFG_PREAMBLE_LONG)) {
7309 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7310 } else {
7311 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7312
7313 /* Clear the short preamble if we won't be supporting it */
7314 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007315 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_PREAMBLE);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007316 }
7317
James Ketrenosafbf30a2005-08-25 00:05:33 -05007318 /* Clear capability bits that aren't used in Ad Hoc */
7319 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7320 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007321 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007322
James Ketrenos43f66a62005-03-25 12:31:53 -06007323 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007324 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007325 roaming ? "Rea" : "A",
Jeff Garzikbf794512005-07-31 13:07:26 -04007326 escape_essid(priv->essid, priv->essid_len),
7327 network->channel,
7328 ipw_modes[priv->assoc_request.ieee_mode],
7329 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007330 (priv->assoc_request.preamble_length ==
7331 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7332 network->capability &
7333 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007334 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007335 priv->capability & CAP_PRIVACY_ON ?
7336 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007337 "(open)") : "",
7338 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007339 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007340 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007341 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007342
Al Viro5b5e8072007-12-27 01:54:06 -05007343 priv->assoc_request.beacon_interval = cpu_to_le16(network->beacon_interval);
James Ketrenos43f66a62005-03-25 12:31:53 -06007344 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007345 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007346 priv->assoc_request.assoc_type = HC_IBSS_START;
7347 priv->assoc_request.assoc_tsf_msw = 0;
7348 priv->assoc_request.assoc_tsf_lsw = 0;
7349 } else {
7350 if (unlikely(roaming))
7351 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7352 else
7353 priv->assoc_request.assoc_type = HC_ASSOCIATE;
Al Viro5b5e8072007-12-27 01:54:06 -05007354 priv->assoc_request.assoc_tsf_msw = cpu_to_le32(network->time_stamp[1]);
7355 priv->assoc_request.assoc_tsf_lsw = cpu_to_le32(network->time_stamp[0]);
James Ketrenos43f66a62005-03-25 12:31:53 -06007356 }
7357
James Ketrenosafbf30a2005-08-25 00:05:33 -05007358 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007359
7360 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7361 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
Al Viro5b5e8072007-12-27 01:54:06 -05007362 priv->assoc_request.atim_window = cpu_to_le16(network->atim_window);
James Ketrenos43f66a62005-03-25 12:31:53 -06007363 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007364 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007365 priv->assoc_request.atim_window = 0;
7366 }
7367
Al Viro5b5e8072007-12-27 01:54:06 -05007368 priv->assoc_request.listen_interval = cpu_to_le16(network->listen_interval);
Jeff Garzikbf794512005-07-31 13:07:26 -04007369
James Ketrenos43f66a62005-03-25 12:31:53 -06007370 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7371 if (err) {
7372 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7373 return err;
7374 }
7375
7376 rates->ieee_mode = priv->assoc_request.ieee_mode;
7377 rates->purpose = IPW_RATE_CONNECT;
7378 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007379
James Ketrenos43f66a62005-03-25 12:31:53 -06007380 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7381 priv->sys_config.dot11g_auto_detection = 1;
7382 else
7383 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007384
7385 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7386 priv->sys_config.answer_broadcast_ssid_probe = 1;
7387 else
7388 priv->sys_config.answer_broadcast_ssid_probe = 0;
7389
Zhu Yid685b8c2006-04-13 17:20:27 +08007390 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007391 if (err) {
7392 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7393 return err;
7394 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007395
James Ketrenos43f66a62005-03-25 12:31:53 -06007396 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007397 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007398 if (err) {
7399 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7400 return err;
7401 }
7402
7403 /*
7404 * If preemption is enabled, it is possible for the association
7405 * to complete before we return from ipw_send_associate. Therefore
7406 * we have to be sure and update our priviate data first.
7407 */
7408 priv->channel = network->channel;
7409 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007410 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007411 priv->status &= ~STATUS_SECURITY_UPDATED;
7412
7413 priv->assoc_network = network;
7414
Zhu Yie43e3c12006-04-13 17:20:45 +08007415#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007416 ipw_qos_association(priv, network);
7417#endif
7418
James Ketrenos43f66a62005-03-25 12:31:53 -06007419 err = ipw_send_associate(priv, &priv->assoc_request);
7420 if (err) {
7421 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7422 return err;
7423 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007424
Joe Perches0795af52007-10-03 17:59:30 -07007425 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' %s \n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007426 escape_essid(priv->essid, priv->essid_len),
Joe Perches0795af52007-10-03 17:59:30 -07007427 print_mac(mac, priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06007428
7429 return 0;
7430}
7431
7432static void ipw_roam(void *data)
7433{
7434 struct ipw_priv *priv = data;
7435 struct ieee80211_network *network = NULL;
7436 struct ipw_network_match match = {
7437 .network = priv->assoc_network
7438 };
7439
7440 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007441 *
7442 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007443 * setting the status ROAM bit and requesting a scan.
7444 * 2. When the scan completes, it schedules the ROAM work
7445 * 3. The ROAM work looks at all of the known networks for one that
7446 * is a better network than the currently associated. If none
7447 * found, the ROAM process is over (ROAM bit cleared)
7448 * 4. If a better network is found, a disassociation request is
7449 * sent.
7450 * 5. When the disassociation completes, the roam work is again
7451 * scheduled. The second time through, the driver is no longer
7452 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007453 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007454 * 6. At this point ,the roaming process is complete and the ROAM
7455 * status bit is cleared.
7456 */
7457
7458 /* If we are no longer associated, and the roaming bit is no longer
7459 * set, then we are not actively roaming, so just return */
7460 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7461 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007462
James Ketrenos43f66a62005-03-25 12:31:53 -06007463 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007464 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007465 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007466 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007467 u8 rssi = priv->assoc_network->stats.rssi;
7468 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007469 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007470 list_for_each_entry(network, &priv->ieee->network_list, list) {
7471 if (network != priv->assoc_network)
7472 ipw_best_network(priv, &match, network, 1);
7473 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007474 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007475 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007476
James Ketrenos43f66a62005-03-25 12:31:53 -06007477 if (match.network == priv->assoc_network) {
7478 IPW_DEBUG_ASSOC("No better APs in this network to "
7479 "roam to.\n");
7480 priv->status &= ~STATUS_ROAMING;
7481 ipw_debug_config(priv);
7482 return;
7483 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007484
James Ketrenos43f66a62005-03-25 12:31:53 -06007485 ipw_send_disassociate(priv, 1);
7486 priv->assoc_network = match.network;
7487
7488 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007489 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007490
7491 /* Second pass through ROAM process -- request association */
7492 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7493 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7494 priv->status &= ~STATUS_ROAMING;
7495}
7496
David Howellsc4028952006-11-22 14:57:56 +00007497static void ipw_bg_roam(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05007498{
David Howellsc4028952006-11-22 14:57:56 +00007499 struct ipw_priv *priv =
7500 container_of(work, struct ipw_priv, roam);
Zhu Yi46441512006-01-24 16:37:59 +08007501 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007502 ipw_roam(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007503 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007504}
7505
7506static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007507{
7508 struct ipw_priv *priv = data;
7509
7510 struct ieee80211_network *network = NULL;
7511 struct ipw_network_match match = {
7512 .network = NULL
7513 };
7514 struct ipw_supported_rates *rates;
7515 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007516 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007517
James Ketrenosb095c382005-08-24 22:04:42 -05007518 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7519 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7520 return 0;
7521 }
7522
James Ketrenosc848d0a2005-08-24 21:56:24 -05007523 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007524 IPW_DEBUG_ASSOC("Not attempting association (already in "
7525 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007526 return 0;
7527 }
7528
Hong Liue6324722005-09-14 21:04:15 -05007529 if (priv->status & STATUS_DISASSOCIATING) {
7530 IPW_DEBUG_ASSOC("Not attempting association (in "
7531 "disassociating)\n ");
7532 queue_work(priv->workqueue, &priv->associate);
7533 return 0;
7534 }
7535
James Ketrenosc848d0a2005-08-24 21:56:24 -05007536 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007537 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7538 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007539 return 0;
7540 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007541
7542 if (!(priv->config & CFG_ASSOCIATE) &&
7543 !(priv->config & (CFG_STATIC_ESSID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007544 CFG_STATIC_CHANNEL | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007545 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007546 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007547 }
7548
James Ketrenosa613bff2005-08-24 21:43:11 -05007549 /* Protect our use of the network_list */
7550 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007551 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007552 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007553
7554 network = match.network;
7555 rates = &match.rates;
7556
7557 if (network == NULL &&
7558 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7559 priv->config & CFG_ADHOC_CREATE &&
7560 priv->config & CFG_STATIC_ESSID &&
James Ketrenosa613bff2005-08-24 21:43:11 -05007561 priv->config & CFG_STATIC_CHANNEL &&
James Ketrenos43f66a62005-03-25 12:31:53 -06007562 !list_empty(&priv->ieee->network_free_list)) {
7563 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007564 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007565 ipw_adhoc_create(priv, network);
7566 rates = &priv->rates;
7567 list_del(element);
7568 list_add_tail(&network->list, &priv->ieee->network_list);
7569 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007570 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007571
James Ketrenos43f66a62005-03-25 12:31:53 -06007572 /* If we reached the end of the list, then we don't have any valid
7573 * matching APs */
7574 if (!network) {
7575 ipw_debug_config(priv);
7576
James Ketrenosb095c382005-08-24 22:04:42 -05007577 if (!(priv->status & STATUS_SCANNING)) {
7578 if (!(priv->config & CFG_SPEED_SCAN))
7579 queue_delayed_work(priv->workqueue,
7580 &priv->request_scan,
7581 SCAN_INTERVAL);
7582 else
David Howellsc4028952006-11-22 14:57:56 +00007583 queue_delayed_work(priv->workqueue,
7584 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05007585 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007586
James Ketrenosc848d0a2005-08-24 21:56:24 -05007587 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007588 }
7589
7590 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007591
7592 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007593}
Jeff Garzikbf794512005-07-31 13:07:26 -04007594
David Howellsc4028952006-11-22 14:57:56 +00007595static void ipw_bg_associate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06007596{
David Howellsc4028952006-11-22 14:57:56 +00007597 struct ipw_priv *priv =
7598 container_of(work, struct ipw_priv, associate);
Zhu Yi46441512006-01-24 16:37:59 +08007599 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007600 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007601 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007602}
7603
James Ketrenosb095c382005-08-24 22:04:42 -05007604static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7605 struct sk_buff *skb)
7606{
7607 struct ieee80211_hdr *hdr;
7608 u16 fc;
7609
7610 hdr = (struct ieee80211_hdr *)skb->data;
7611 fc = le16_to_cpu(hdr->frame_ctl);
7612 if (!(fc & IEEE80211_FCTL_PROTECTED))
7613 return;
7614
7615 fc &= ~IEEE80211_FCTL_PROTECTED;
7616 hdr->frame_ctl = cpu_to_le16(fc);
7617 switch (priv->ieee->sec.level) {
7618 case SEC_LEVEL_3:
7619 /* Remove CCMP HDR */
7620 memmove(skb->data + IEEE80211_3ADDR_LEN,
7621 skb->data + IEEE80211_3ADDR_LEN + 8,
7622 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007623 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007624 break;
7625 case SEC_LEVEL_2:
7626 break;
7627 case SEC_LEVEL_1:
7628 /* Remove IV */
7629 memmove(skb->data + IEEE80211_3ADDR_LEN,
7630 skb->data + IEEE80211_3ADDR_LEN + 4,
7631 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007632 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007633 break;
7634 case SEC_LEVEL_0:
7635 break;
7636 default:
7637 printk(KERN_ERR "Unknow security level %d\n",
7638 priv->ieee->sec.level);
7639 break;
7640 }
7641}
7642
7643static void ipw_handle_data_packet(struct ipw_priv *priv,
7644 struct ipw_rx_mem_buffer *rxb,
7645 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007646{
Hong Liu567deaf2005-08-31 18:07:22 +08007647 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007648 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7649
7650 /* We received data from the HW, so stop the watchdog */
7651 priv->net_dev->trans_start = jiffies;
7652
Jeff Garzikbf794512005-07-31 13:07:26 -04007653 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007654 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007655 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007656 skb_tailroom(rxb->skb))) {
7657 priv->ieee->stats.rx_errors++;
7658 priv->wstats.discard.misc++;
7659 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7660 return;
7661 } else if (unlikely(!netif_running(priv->net_dev))) {
7662 priv->ieee->stats.rx_dropped++;
7663 priv->wstats.discard.misc++;
7664 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7665 return;
7666 }
7667
7668 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007669 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007670
7671 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007672 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007673
7674 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7675
James Ketrenosb095c382005-08-24 22:04:42 -05007676 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007677 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7678 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007679 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007680 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007681 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7682
Jeff Garzikbf794512005-07-31 13:07:26 -04007683 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
James Ketrenos43f66a62005-03-25 12:31:53 -06007684 priv->ieee->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007685 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007686 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007687 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007688 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007689}
7690
Zhu Yi459d4082006-04-13 17:21:00 +08007691#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007692static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7693 struct ipw_rx_mem_buffer *rxb,
7694 struct ieee80211_rx_stats *stats)
7695{
7696 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7697 struct ipw_rx_frame *frame = &pkt->u.frame;
7698
7699 /* initial pull of some data */
7700 u16 received_channel = frame->received_channel;
7701 u8 antennaAndPhy = frame->antennaAndPhy;
7702 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7703 u16 pktrate = frame->rate;
7704
7705 /* Magic struct that slots into the radiotap header -- no reason
7706 * to build this manually element by element, we can write it much
7707 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007708 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007709
7710 short len = le16_to_cpu(pkt->u.frame.length);
7711
7712 /* We received data from the HW, so stop the watchdog */
7713 priv->net_dev->trans_start = jiffies;
7714
7715 /* We only process data packets if the
7716 * interface is open */
7717 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7718 skb_tailroom(rxb->skb))) {
7719 priv->ieee->stats.rx_errors++;
7720 priv->wstats.discard.misc++;
7721 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7722 return;
7723 } else if (unlikely(!netif_running(priv->net_dev))) {
7724 priv->ieee->stats.rx_dropped++;
7725 priv->wstats.discard.misc++;
7726 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7727 return;
7728 }
7729
7730 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7731 * that now */
7732 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7733 /* FIXME: Should alloc bigger skb instead */
7734 priv->ieee->stats.rx_dropped++;
7735 priv->wstats.discard.misc++;
7736 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7737 return;
7738 }
7739
7740 /* copy the frame itself */
7741 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7742 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7743
7744 /* Zero the radiotap static buffer ... We only need to zero the bytes NOT
7745 * part of our real header, saves a little time.
7746 *
7747 * No longer necessary since we fill in all our data. Purge before merging
7748 * patch officially.
7749 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7750 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7751 */
7752
7753 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7754
7755 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7756 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05007757 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(struct ipw_rt_hdr)); /* total header+data */
Mike Kershaw24a47db2005-08-26 00:41:54 -05007758
7759 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05007760 ipw_rt->rt_hdr.it_present = cpu_to_le32(
7761 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007762 (1 << IEEE80211_RADIOTAP_FLAGS) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007763 (1 << IEEE80211_RADIOTAP_RATE) |
7764 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7765 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007766 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007767 (1 << IEEE80211_RADIOTAP_ANTENNA));
7768
7769 /* Zero the flags, we'll add to them as we go */
7770 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007771 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7772 frame->parent_tsf[2] << 16 |
7773 frame->parent_tsf[1] << 8 |
7774 frame->parent_tsf[0]);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007775
7776 /* Convert signal to DBM */
7777 ipw_rt->rt_dbmsignal = antsignal;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007778 ipw_rt->rt_dbmnoise = frame->noise;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007779
7780 /* Convert the channel data and set the flags */
7781 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7782 if (received_channel > 14) { /* 802.11a */
7783 ipw_rt->rt_chbitmask =
7784 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7785 } else if (antennaAndPhy & 32) { /* 802.11b */
7786 ipw_rt->rt_chbitmask =
7787 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7788 } else { /* 802.11g */
7789 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05007790 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007791 }
7792
7793 /* set the rate in multiples of 500k/s */
7794 switch (pktrate) {
7795 case IPW_TX_RATE_1MB:
7796 ipw_rt->rt_rate = 2;
7797 break;
7798 case IPW_TX_RATE_2MB:
7799 ipw_rt->rt_rate = 4;
7800 break;
7801 case IPW_TX_RATE_5MB:
7802 ipw_rt->rt_rate = 10;
7803 break;
7804 case IPW_TX_RATE_6MB:
7805 ipw_rt->rt_rate = 12;
7806 break;
7807 case IPW_TX_RATE_9MB:
7808 ipw_rt->rt_rate = 18;
7809 break;
7810 case IPW_TX_RATE_11MB:
7811 ipw_rt->rt_rate = 22;
7812 break;
7813 case IPW_TX_RATE_12MB:
7814 ipw_rt->rt_rate = 24;
7815 break;
7816 case IPW_TX_RATE_18MB:
7817 ipw_rt->rt_rate = 36;
7818 break;
7819 case IPW_TX_RATE_24MB:
7820 ipw_rt->rt_rate = 48;
7821 break;
7822 case IPW_TX_RATE_36MB:
7823 ipw_rt->rt_rate = 72;
7824 break;
7825 case IPW_TX_RATE_48MB:
7826 ipw_rt->rt_rate = 96;
7827 break;
7828 case IPW_TX_RATE_54MB:
7829 ipw_rt->rt_rate = 108;
7830 break;
7831 default:
7832 ipw_rt->rt_rate = 0;
7833 break;
7834 }
7835
7836 /* antenna number */
7837 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7838
7839 /* set the preamble flag if we have it */
7840 if ((antennaAndPhy & 64))
7841 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7842
7843 /* Set the size of the skb to the size of the frame */
7844 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007845
7846 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7847
7848 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
7849 priv->ieee->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007850 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007851 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007852 /* no LED during capture */
7853 }
7854}
7855#endif
7856
Zhu Yid685b8c2006-04-13 17:20:27 +08007857#ifdef CONFIG_IPW2200_PROMISCUOUS
7858#define ieee80211_is_probe_response(fc) \
7859 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7860 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7861
7862#define ieee80211_is_management(fc) \
7863 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7864
7865#define ieee80211_is_control(fc) \
7866 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7867
7868#define ieee80211_is_data(fc) \
7869 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7870
7871#define ieee80211_is_assoc_request(fc) \
7872 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7873
7874#define ieee80211_is_reassoc_request(fc) \
7875 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7876
7877static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7878 struct ipw_rx_mem_buffer *rxb,
7879 struct ieee80211_rx_stats *stats)
7880{
7881 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7882 struct ipw_rx_frame *frame = &pkt->u.frame;
7883 struct ipw_rt_hdr *ipw_rt;
7884
7885 /* First cache any information we need before we overwrite
7886 * the information provided in the skb from the hardware */
7887 struct ieee80211_hdr *hdr;
7888 u16 channel = frame->received_channel;
7889 u8 phy_flags = frame->antennaAndPhy;
7890 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7891 s8 noise = frame->noise;
7892 u8 rate = frame->rate;
7893 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007894 struct sk_buff *skb;
7895 int hdr_only = 0;
7896 u16 filter = priv->prom_priv->filter;
7897
7898 /* If the filter is set to not include Rx frames then return */
7899 if (filter & IPW_PROM_NO_RX)
7900 return;
7901
Zhu Yid685b8c2006-04-13 17:20:27 +08007902 /* We received data from the HW, so stop the watchdog */
7903 priv->prom_net_dev->trans_start = jiffies;
7904
7905 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
7906 priv->prom_priv->ieee->stats.rx_errors++;
7907 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7908 return;
7909 }
7910
7911 /* We only process data packets if the interface is open */
7912 if (unlikely(!netif_running(priv->prom_net_dev))) {
7913 priv->prom_priv->ieee->stats.rx_dropped++;
7914 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7915 return;
7916 }
7917
7918 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7919 * that now */
7920 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7921 /* FIXME: Should alloc bigger skb instead */
7922 priv->prom_priv->ieee->stats.rx_dropped++;
7923 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7924 return;
7925 }
7926
7927 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
Zhu Yi851ca262006-08-21 11:37:58 +08007928 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007929 if (filter & IPW_PROM_NO_MGMT)
7930 return;
7931 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
7932 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007933 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007934 if (filter & IPW_PROM_NO_CTL)
7935 return;
7936 if (filter & IPW_PROM_CTL_HEADER_ONLY)
7937 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007938 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007939 if (filter & IPW_PROM_NO_DATA)
7940 return;
7941 if (filter & IPW_PROM_DATA_HEADER_ONLY)
7942 hdr_only = 1;
7943 }
7944
7945 /* Copy the SKB since this is for the promiscuous side */
7946 skb = skb_copy(rxb->skb, GFP_ATOMIC);
7947 if (skb == NULL) {
7948 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
7949 return;
7950 }
7951
7952 /* copy the frame data to write after where the radiotap header goes */
7953 ipw_rt = (void *)skb->data;
7954
7955 if (hdr_only)
Zhu Yi851ca262006-08-21 11:37:58 +08007956 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +08007957
7958 memcpy(ipw_rt->payload, hdr, len);
7959
7960 /* Zero the radiotap static buffer ... We only need to zero the bytes
7961 * NOT part of our real header, saves a little time.
7962 *
7963 * No longer necessary since we fill in all our data. Purge before
7964 * merging patch officially.
7965 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7966 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7967 */
7968
7969 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7970 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05007971 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(*ipw_rt)); /* total header+data */
Zhu Yid685b8c2006-04-13 17:20:27 +08007972
7973 /* Set the size of the skb to the size of the frame */
Al Viro743b84d2007-12-27 01:43:16 -05007974 skb_put(skb, sizeof(*ipw_rt) + len);
Zhu Yid685b8c2006-04-13 17:20:27 +08007975
7976 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05007977 ipw_rt->rt_hdr.it_present = cpu_to_le32(
7978 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007979 (1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007980 (1 << IEEE80211_RADIOTAP_RATE) |
7981 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7982 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
7983 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
7984 (1 << IEEE80211_RADIOTAP_ANTENNA));
7985
7986 /* Zero the flags, we'll add to them as we go */
7987 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007988 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7989 frame->parent_tsf[2] << 16 |
7990 frame->parent_tsf[1] << 8 |
7991 frame->parent_tsf[0]);
Zhu Yid685b8c2006-04-13 17:20:27 +08007992
7993 /* Convert to DBM */
7994 ipw_rt->rt_dbmsignal = signal;
7995 ipw_rt->rt_dbmnoise = noise;
7996
7997 /* Convert the channel data and set the flags */
7998 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
7999 if (channel > 14) { /* 802.11a */
8000 ipw_rt->rt_chbitmask =
8001 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
8002 } else if (phy_flags & (1 << 5)) { /* 802.11b */
8003 ipw_rt->rt_chbitmask =
8004 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
8005 } else { /* 802.11g */
8006 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05008007 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Zhu Yid685b8c2006-04-13 17:20:27 +08008008 }
8009
8010 /* set the rate in multiples of 500k/s */
8011 switch (rate) {
8012 case IPW_TX_RATE_1MB:
8013 ipw_rt->rt_rate = 2;
8014 break;
8015 case IPW_TX_RATE_2MB:
8016 ipw_rt->rt_rate = 4;
8017 break;
8018 case IPW_TX_RATE_5MB:
8019 ipw_rt->rt_rate = 10;
8020 break;
8021 case IPW_TX_RATE_6MB:
8022 ipw_rt->rt_rate = 12;
8023 break;
8024 case IPW_TX_RATE_9MB:
8025 ipw_rt->rt_rate = 18;
8026 break;
8027 case IPW_TX_RATE_11MB:
8028 ipw_rt->rt_rate = 22;
8029 break;
8030 case IPW_TX_RATE_12MB:
8031 ipw_rt->rt_rate = 24;
8032 break;
8033 case IPW_TX_RATE_18MB:
8034 ipw_rt->rt_rate = 36;
8035 break;
8036 case IPW_TX_RATE_24MB:
8037 ipw_rt->rt_rate = 48;
8038 break;
8039 case IPW_TX_RATE_36MB:
8040 ipw_rt->rt_rate = 72;
8041 break;
8042 case IPW_TX_RATE_48MB:
8043 ipw_rt->rt_rate = 96;
8044 break;
8045 case IPW_TX_RATE_54MB:
8046 ipw_rt->rt_rate = 108;
8047 break;
8048 default:
8049 ipw_rt->rt_rate = 0;
8050 break;
8051 }
8052
8053 /* antenna number */
8054 ipw_rt->rt_antenna = (phy_flags & 3);
8055
8056 /* set the preamble flag if we have it */
8057 if (phy_flags & (1 << 6))
8058 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
8059
8060 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
8061
8062 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
8063 priv->prom_priv->ieee->stats.rx_errors++;
8064 dev_kfree_skb_any(skb);
8065 }
8066}
8067#endif
8068
Arjan van de Ven858119e2006-01-14 13:20:43 -08008069static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05008070 struct ieee80211_hdr_4addr *header)
8071{
8072 /* Filter incoming packets to determine if they are targetted toward
8073 * this network, discarding packets coming from ourselves */
8074 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05008075 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008076 /* packets from our adapter are dropped (echo) */
8077 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
8078 return 0;
8079
Peter Jones90700fd2005-08-26 16:51:06 -05008080 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008081 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05008082 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008083
8084 /* packets to our adapter go through */
8085 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8086 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008087
Peter Jones90700fd2005-08-26 16:51:06 -05008088 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008089 /* packets from our adapter are dropped (echo) */
8090 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
8091 return 0;
8092
Peter Jones90700fd2005-08-26 16:51:06 -05008093 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008094 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05008095 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
8096
8097 /* packets to our adapter go through */
8098 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8099 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05008100 }
James Ketrenosa613bff2005-08-24 21:43:11 -05008101
James Ketrenosea2b26e2005-08-24 21:25:16 -05008102 return 1;
8103}
8104
James Ketrenosafbf30a2005-08-25 00:05:33 -05008105#define IPW_PACKET_RETRY_TIME HZ
8106
Arjan van de Ven858119e2006-01-14 13:20:43 -08008107static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05008108 struct ieee80211_hdr_4addr *header)
8109{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008110 u16 sc = le16_to_cpu(header->seq_ctl);
8111 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8112 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8113 u16 *last_seq, *last_frag;
8114 unsigned long *last_time;
8115
8116 switch (priv->ieee->iw_mode) {
8117 case IW_MODE_ADHOC:
8118 {
8119 struct list_head *p;
8120 struct ipw_ibss_seq *entry = NULL;
8121 u8 *mac = header->addr2;
8122 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8123
8124 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8125 entry =
8126 list_entry(p, struct ipw_ibss_seq, list);
8127 if (!memcmp(entry->mac, mac, ETH_ALEN))
8128 break;
8129 }
8130 if (p == &priv->ibss_mac_hash[index]) {
8131 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8132 if (!entry) {
8133 IPW_ERROR
8134 ("Cannot malloc new mac entry\n");
8135 return 0;
8136 }
8137 memcpy(entry->mac, mac, ETH_ALEN);
8138 entry->seq_num = seq;
8139 entry->frag_num = frag;
8140 entry->packet_time = jiffies;
8141 list_add(&entry->list,
8142 &priv->ibss_mac_hash[index]);
8143 return 0;
8144 }
8145 last_seq = &entry->seq_num;
8146 last_frag = &entry->frag_num;
8147 last_time = &entry->packet_time;
8148 break;
8149 }
8150 case IW_MODE_INFRA:
8151 last_seq = &priv->last_seq_num;
8152 last_frag = &priv->last_frag_num;
8153 last_time = &priv->last_packet_time;
8154 break;
8155 default:
8156 return 0;
8157 }
8158 if ((*last_seq == seq) &&
8159 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8160 if (*last_frag == frag)
8161 goto drop;
8162 if (*last_frag + 1 != frag)
8163 /* out-of-order fragment */
8164 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008165 } else
8166 *last_seq = seq;
8167
Zhu Yif57ce7c2005-07-13 12:22:15 -05008168 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008169 *last_time = jiffies;
8170 return 0;
8171
8172 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008173 /* Comment this line now since we observed the card receives
8174 * duplicate packets but the FCTL_RETRY bit is not set in the
8175 * IBSS mode with fragmentation enabled.
8176 BUG_ON(!(le16_to_cpu(header->frame_ctl) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008177 return 1;
8178}
8179
James Ketrenosb095c382005-08-24 22:04:42 -05008180static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8181 struct ipw_rx_mem_buffer *rxb,
8182 struct ieee80211_rx_stats *stats)
8183{
8184 struct sk_buff *skb = rxb->skb;
8185 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8186 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8187 (skb->data + IPW_RX_FRAME_SIZE);
8188
8189 ieee80211_rx_mgt(priv->ieee, header, stats);
8190
8191 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8192 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8193 IEEE80211_STYPE_PROBE_RESP) ||
8194 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8195 IEEE80211_STYPE_BEACON))) {
8196 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8197 ipw_add_station(priv, header->addr2);
8198 }
8199
8200 if (priv->config & CFG_NET_STATS) {
8201 IPW_DEBUG_HC("sending stat packet\n");
8202
8203 /* Set the size of the skb to the size of the full
8204 * ipw header and 802.11 frame */
8205 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8206 IPW_RX_FRAME_SIZE);
8207
8208 /* Advance past the ipw packet header to the 802.11 frame */
8209 skb_pull(skb, IPW_RX_FRAME_SIZE);
8210
8211 /* Push the ieee80211_rx_stats before the 802.11 frame */
8212 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8213
8214 skb->dev = priv->ieee->dev;
8215
8216 /* Point raw at the ieee80211_stats */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07008217 skb_reset_mac_header(skb);
James Ketrenosb095c382005-08-24 22:04:42 -05008218
8219 skb->pkt_type = PACKET_OTHERHOST;
8220 skb->protocol = __constant_htons(ETH_P_80211_STATS);
8221 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8222 netif_rx(skb);
8223 rxb->skb = NULL;
8224 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008225}
8226
James Ketrenos43f66a62005-03-25 12:31:53 -06008227/*
8228 * Main entry function for recieving a packet with 80211 headers. This
8229 * should be called when ever the FW has notified us that there is a new
8230 * skb in the recieve queue.
8231 */
8232static void ipw_rx(struct ipw_priv *priv)
8233{
8234 struct ipw_rx_mem_buffer *rxb;
8235 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008236 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008237 u32 r, w, i;
8238 u8 network_packet;
Dan Williams943dbef2008-02-14 17:49:41 -05008239 u8 fill_rx = 0;
Joe Perches0795af52007-10-03 17:59:30 -07008240 DECLARE_MAC_BUF(mac);
8241 DECLARE_MAC_BUF(mac2);
8242 DECLARE_MAC_BUF(mac3);
James Ketrenos43f66a62005-03-25 12:31:53 -06008243
James Ketrenosb095c382005-08-24 22:04:42 -05008244 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8245 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
Dan Williams943dbef2008-02-14 17:49:41 -05008246 i = priv->rxq->read;
8247
8248 if (ipw_rx_queue_space (priv->rxq) > (RX_QUEUE_SIZE / 2))
8249 fill_rx = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008250
8251 while (i != r) {
8252 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008253 if (unlikely(rxb == NULL)) {
8254 printk(KERN_CRIT "Queue not allocated!\n");
8255 break;
8256 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008257 priv->rxq->queue[i] = NULL;
8258
8259 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008260 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008261 PCI_DMA_FROMDEVICE);
8262
8263 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8264 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8265 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008266 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008267
8268 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008269 case RX_FRAME_TYPE: /* 802.11 frame */ {
8270 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008271 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008272 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008273 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008274 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8275 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008276 .noise =
8277 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008278 .rate = pkt->u.frame.rate,
8279 .mac_time = jiffies,
8280 .received_channel =
8281 pkt->u.frame.received_channel,
8282 .freq =
8283 (pkt->u.frame.
8284 control & (1 << 0)) ?
8285 IEEE80211_24GHZ_BAND :
8286 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008287 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008288 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008289
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008290 if (stats.rssi != 0)
8291 stats.mask |= IEEE80211_STATMASK_RSSI;
8292 if (stats.signal != 0)
8293 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008294 if (stats.noise != 0)
8295 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008296 if (stats.rate != 0)
8297 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008298
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008299 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008300
Zhu Yid685b8c2006-04-13 17:20:27 +08008301#ifdef CONFIG_IPW2200_PROMISCUOUS
8302 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8303 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8304#endif
8305
James Ketrenosb095c382005-08-24 22:04:42 -05008306#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008307 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008308#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008309
8310 ipw_handle_data_packet_monitor(priv,
8311 rxb,
8312 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008313#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008314 ipw_handle_data_packet(priv, rxb,
8315 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008316#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008317 break;
8318 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008319#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008320
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008321 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008322 (struct ieee80211_hdr_4addr *)(rxb->skb->
8323 data +
8324 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008325 /* TODO: Check Ad-Hoc dest/source and make sure
8326 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008327 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008328 * frame control of the packet and disregard
8329 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008330
James Ketrenosea2b26e2005-08-24 21:25:16 -05008331 network_packet =
8332 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008333 if (network_packet && priv->assoc_network) {
8334 priv->assoc_network->stats.rssi =
8335 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008336 priv->exp_avg_rssi =
8337 exponential_average(priv->exp_avg_rssi,
8338 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008339 }
8340
8341 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008342 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008343
James Ketrenosa613bff2005-08-24 21:43:11 -05008344 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008345 ieee80211_get_hdrlen(le16_to_cpu(
8346 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008347 IPW_DEBUG_DROP
8348 ("Received packet is too small. "
8349 "Dropping.\n");
8350 priv->ieee->stats.rx_errors++;
8351 priv->wstats.discard.misc++;
8352 break;
8353 }
8354
James Ketrenosa613bff2005-08-24 21:43:11 -05008355 switch (WLAN_FC_GET_TYPE
8356 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008357
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008358 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008359 ipw_handle_mgmt_packet(priv, rxb,
8360 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008361 break;
8362
8363 case IEEE80211_FTYPE_CTL:
8364 break;
8365
8366 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008367 if (unlikely(!network_packet ||
8368 is_duplicate_packet(priv,
8369 header)))
8370 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008371 IPW_DEBUG_DROP("Dropping: "
Joe Perches0795af52007-10-03 17:59:30 -07008372 "%s, "
8373 "%s, "
8374 "%s\n",
8375 print_mac(mac,
8376 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008377 addr1),
Joe Perches0795af52007-10-03 17:59:30 -07008378 print_mac(mac2,
8379 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008380 addr2),
Joe Perches0795af52007-10-03 17:59:30 -07008381 print_mac(mac3,
8382 header->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008383 addr3));
James Ketrenosb095c382005-08-24 22:04:42 -05008384 break;
8385 }
8386
8387 ipw_handle_data_packet(priv, rxb,
8388 &stats);
8389
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008390 break;
8391 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008392 break;
8393 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008394
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008395 case RX_HOST_NOTIFICATION_TYPE:{
8396 IPW_DEBUG_RX
8397 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008398 pkt->u.notification.subtype,
8399 pkt->u.notification.flags,
Zhu Yi720eeb42006-12-05 14:41:40 +08008400 le16_to_cpu(pkt->u.notification.size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008401 ipw_rx_notification(priv, &pkt->u.notification);
8402 break;
8403 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008404
8405 default:
8406 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8407 pkt->header.message_type);
8408 break;
8409 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008410
8411 /* For now we just don't re-use anything. We can tweak this
8412 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008413 * fail to Rx correctly */
8414 if (rxb->skb != NULL) {
8415 dev_kfree_skb_any(rxb->skb);
8416 rxb->skb = NULL;
8417 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008418
James Ketrenos43f66a62005-03-25 12:31:53 -06008419 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008420 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008421 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008422
James Ketrenos43f66a62005-03-25 12:31:53 -06008423 i = (i + 1) % RX_QUEUE_SIZE;
Dan Williams943dbef2008-02-14 17:49:41 -05008424
8425 /* If there are a lot of unsued frames, restock the Rx queue
8426 * so the ucode won't assert */
8427 if (fill_rx) {
8428 priv->rxq->read = i;
8429 ipw_rx_queue_replenish(priv);
8430 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008431 }
8432
8433 /* Backtrack one entry */
Dan Williams943dbef2008-02-14 17:49:41 -05008434 priv->rxq->read = i;
James Ketrenos43f66a62005-03-25 12:31:53 -06008435 ipw_rx_queue_restock(priv);
8436}
8437
James Ketrenosafbf30a2005-08-25 00:05:33 -05008438#define DEFAULT_RTS_THRESHOLD 2304U
8439#define MIN_RTS_THRESHOLD 1U
8440#define MAX_RTS_THRESHOLD 2304U
8441#define DEFAULT_BEACON_INTERVAL 100U
8442#define DEFAULT_SHORT_RETRY_LIMIT 7U
8443#define DEFAULT_LONG_RETRY_LIMIT 4U
8444
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008445/**
8446 * ipw_sw_reset
8447 * @option: options to control different reset behaviour
8448 * 0 = reset everything except the 'disable' module_param
8449 * 1 = reset everything and print out driver info (for probe only)
8450 * 2 = reset everything
8451 */
8452static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008453{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008454 int band, modulation;
8455 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008456
James Ketrenosafbf30a2005-08-25 00:05:33 -05008457 /* Initialize module parameter values here */
8458 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008459
James Ketrenosafbf30a2005-08-25 00:05:33 -05008460 /* We default to disabling the LED code as right now it causes
8461 * too many systems to lock up... */
8462 if (!led)
8463 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008464
James Ketrenosafbf30a2005-08-25 00:05:33 -05008465 if (associate)
8466 priv->config |= CFG_ASSOCIATE;
8467 else
8468 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008469
James Ketrenosafbf30a2005-08-25 00:05:33 -05008470 if (auto_create)
8471 priv->config |= CFG_ADHOC_CREATE;
8472 else
8473 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8474
Zhu Yi17ed0812006-01-24 16:36:31 +08008475 priv->config &= ~CFG_STATIC_ESSID;
8476 priv->essid_len = 0;
8477 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8478
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008479 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008480 priv->status |= STATUS_RF_KILL_SW;
8481 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008482 }
8483
James Ketrenosafbf30a2005-08-25 00:05:33 -05008484 if (channel != 0) {
8485 priv->config |= CFG_STATIC_CHANNEL;
8486 priv->channel = channel;
8487 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8488 /* TODO: Validate that provided channel is in range */
8489 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008490#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008491 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8492 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008493#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008494
8495 switch (mode) {
8496 case 1:
8497 priv->ieee->iw_mode = IW_MODE_ADHOC;
8498 priv->net_dev->type = ARPHRD_ETHER;
8499
8500 break;
8501#ifdef CONFIG_IPW2200_MONITOR
8502 case 2:
8503 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008504#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008505 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8506#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008507 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008508#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008509 break;
8510#endif
8511 default:
8512 case 0:
8513 priv->net_dev->type = ARPHRD_ETHER;
8514 priv->ieee->iw_mode = IW_MODE_INFRA;
8515 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008516 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008517
James Ketrenosafbf30a2005-08-25 00:05:33 -05008518 if (hwcrypto) {
8519 priv->ieee->host_encrypt = 0;
8520 priv->ieee->host_encrypt_msdu = 0;
8521 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008522 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008523 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008524 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008525
Zhu Yie402c932005-08-05 17:20:40 +08008526 /* IPW2200/2915 is abled to do hardware fragmentation. */
8527 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008528
James Ketrenosafbf30a2005-08-25 00:05:33 -05008529 if ((priv->pci_dev->device == 0x4223) ||
8530 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008531 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008532 printk(KERN_INFO DRV_NAME
8533 ": Detected Intel PRO/Wireless 2915ABG Network "
8534 "Connection\n");
8535 priv->ieee->abg_true = 1;
8536 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8537 modulation = IEEE80211_OFDM_MODULATION |
8538 IEEE80211_CCK_MODULATION;
8539 priv->adapter = IPW_2915ABG;
8540 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008541 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008542 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008543 printk(KERN_INFO DRV_NAME
8544 ": Detected Intel PRO/Wireless 2200BG Network "
8545 "Connection\n");
8546
8547 priv->ieee->abg_true = 0;
8548 band = IEEE80211_24GHZ_BAND;
8549 modulation = IEEE80211_OFDM_MODULATION |
8550 IEEE80211_CCK_MODULATION;
8551 priv->adapter = IPW_2200BG;
8552 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008553 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008554
James Ketrenosafbf30a2005-08-25 00:05:33 -05008555 priv->ieee->freq_band = band;
8556 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008557
James Ketrenosafbf30a2005-08-25 00:05:33 -05008558 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008559
James Ketrenosafbf30a2005-08-25 00:05:33 -05008560 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8561 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008562
James Ketrenosafbf30a2005-08-25 00:05:33 -05008563 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8564 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8565 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008566
James Ketrenosafbf30a2005-08-25 00:05:33 -05008567 /* If power management is turned on, default to AC mode */
8568 priv->power_mode = IPW_POWER_AC;
8569 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008570
Zhu Yi0ece35b2005-08-05 17:26:51 +08008571 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008572}
8573
8574/*
8575 * This file defines the Wireless Extension handlers. It does not
8576 * define any methods of hardware manipulation and relies on the
8577 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008578 *
8579 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008580 * function used to poll the hardware vs. making unecessary calls.
8581 *
8582 */
8583
Jeff Garzikbf794512005-07-31 13:07:26 -04008584static int ipw_wx_get_name(struct net_device *dev,
8585 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008586 union iwreq_data *wrqu, char *extra)
8587{
8588 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008589 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008590 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008591 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008592 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008593 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008594 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008595 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8596 ipw_modes[priv->assoc_request.ieee_mode]);
8597 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008598 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008599 return 0;
8600}
8601
8602static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8603{
8604 if (channel == 0) {
8605 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8606 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008607 IPW_DEBUG_ASSOC("Attempting to associate with new "
8608 "parameters.\n");
8609 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008610 return 0;
8611 }
8612
8613 priv->config |= CFG_STATIC_CHANNEL;
8614
8615 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008616 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8617 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008618 return 0;
8619 }
8620
8621 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8622 priv->channel = channel;
8623
James Ketrenosb095c382005-08-24 22:04:42 -05008624#ifdef CONFIG_IPW2200_MONITOR
8625 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008626 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008627 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008628 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008629 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008630 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008631 }
8632
8633 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8634 udelay(10);
8635
8636 if (priv->status & STATUS_SCANNING)
8637 IPW_DEBUG_SCAN("Still scanning...\n");
8638 else
8639 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8640 1000 - i);
8641
8642 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008643 }
James Ketrenosb095c382005-08-24 22:04:42 -05008644#endif /* CONFIG_IPW2200_MONITOR */
8645
James Ketrenosc848d0a2005-08-24 21:56:24 -05008646 /* Network configuration changed -- force [re]association */
8647 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8648 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008649 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008650
8651 return 0;
8652}
8653
Jeff Garzikbf794512005-07-31 13:07:26 -04008654static int ipw_wx_set_freq(struct net_device *dev,
8655 struct iw_request_info *info,
8656 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008657{
8658 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008659 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008660 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008661 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008662 u8 channel, flags;
8663 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008664
James Ketrenosb095c382005-08-24 22:04:42 -05008665 if (fwrq->m == 0) {
8666 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008667 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008668 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008669 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008670 return ret;
8671 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008672 /* if setting by freq convert to channel */
8673 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008674 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008675 if (channel == 0)
8676 return -EINVAL;
8677 } else
8678 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008679
Larry Finger1867b112006-02-28 09:48:28 -06008680 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008681 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008682
Liu Hong1fe0adb2005-08-19 09:33:10 -05008683 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008684 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008685 if (i == -1)
8686 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008687
8688 flags = (band == IEEE80211_24GHZ_BAND) ?
8689 geo->bg[i].flags : geo->a[i].flags;
8690 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008691 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8692 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008693 }
8694 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008695
James Ketrenos43f66a62005-03-25 12:31:53 -06008696 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008697 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008698 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008699 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008700 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008701}
8702
Jeff Garzikbf794512005-07-31 13:07:26 -04008703static int ipw_wx_get_freq(struct net_device *dev,
8704 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008705 union iwreq_data *wrqu, char *extra)
8706{
8707 struct ipw_priv *priv = ieee80211_priv(dev);
8708
8709 wrqu->freq.e = 0;
8710
8711 /* If we are associated, trying to associate, or have a statically
8712 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008713 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008714 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008715 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8716 int i;
8717
8718 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8719 BUG_ON(i == -1);
8720 wrqu->freq.e = 1;
8721
8722 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8723 case IEEE80211_52GHZ_BAND:
8724 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8725 break;
8726
8727 case IEEE80211_24GHZ_BAND:
8728 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8729 break;
8730
8731 default:
8732 BUG();
8733 }
8734 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008735 wrqu->freq.m = 0;
8736
Zhu Yi46441512006-01-24 16:37:59 +08008737 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008738 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8739 return 0;
8740}
8741
Jeff Garzikbf794512005-07-31 13:07:26 -04008742static int ipw_wx_set_mode(struct net_device *dev,
8743 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008744 union iwreq_data *wrqu, char *extra)
8745{
8746 struct ipw_priv *priv = ieee80211_priv(dev);
8747 int err = 0;
8748
8749 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8750
James Ketrenos43f66a62005-03-25 12:31:53 -06008751 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008752#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008753 case IW_MODE_MONITOR:
8754#endif
8755 case IW_MODE_ADHOC:
8756 case IW_MODE_INFRA:
8757 break;
8758 case IW_MODE_AUTO:
8759 wrqu->mode = IW_MODE_INFRA;
8760 break;
8761 default:
8762 return -EINVAL;
8763 }
James Ketrenosb095c382005-08-24 22:04:42 -05008764 if (wrqu->mode == priv->ieee->iw_mode)
8765 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008766
Zhu Yi46441512006-01-24 16:37:59 +08008767 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008768
8769 ipw_sw_reset(priv, 0);
8770
James Ketrenosb095c382005-08-24 22:04:42 -05008771#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008772 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008773 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008774
8775 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008776#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008777 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8778#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008779 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008780#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008781#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008782
Jeff Garzikbf794512005-07-31 13:07:26 -04008783 /* Free the existing firmware and reset the fw_loaded
James Ketrenos43f66a62005-03-25 12:31:53 -06008784 * flag so ipw_load() will bring in the new firmawre */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008785 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008786
8787 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008788
James Ketrenosc848d0a2005-08-24 21:56:24 -05008789 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008790 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008791 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008792}
8793
Jeff Garzikbf794512005-07-31 13:07:26 -04008794static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008795 struct iw_request_info *info,
8796 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008797{
8798 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008799 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008800 wrqu->mode = priv->ieee->iw_mode;
8801 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008802 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008803 return 0;
8804}
8805
James Ketrenos43f66a62005-03-25 12:31:53 -06008806/* Values are in microsecond */
8807static const s32 timeout_duration[] = {
8808 350000,
8809 250000,
8810 75000,
8811 37000,
8812 25000,
8813};
8814
8815static const s32 period_duration[] = {
8816 400000,
8817 700000,
8818 1000000,
8819 1000000,
8820 1000000
8821};
8822
Jeff Garzikbf794512005-07-31 13:07:26 -04008823static int ipw_wx_get_range(struct net_device *dev,
8824 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008825 union iwreq_data *wrqu, char *extra)
8826{
8827 struct ipw_priv *priv = ieee80211_priv(dev);
8828 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008829 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008830 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008831
8832 wrqu->data.length = sizeof(*range);
8833 memset(range, 0, sizeof(*range));
8834
8835 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008836 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008837
8838 range->max_qual.qual = 100;
8839 /* TODO: Find real max RSSI and stick here */
8840 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008841 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008842 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008843
8844 range->avg_qual.qual = 70;
8845 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008846 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008847 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008848 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008849 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008850 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008851
Jeff Garzikbf794512005-07-31 13:07:26 -04008852 for (i = 0; i < range->num_bitrates; i++)
8853 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008854 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008855
James Ketrenos43f66a62005-03-25 12:31:53 -06008856 range->max_rts = DEFAULT_RTS_THRESHOLD;
8857 range->min_frag = MIN_FRAG_THRESHOLD;
8858 range->max_frag = MAX_FRAG_THRESHOLD;
8859
8860 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008861 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008862 range->num_encoding_sizes = 2;
8863 range->max_encoding_tokens = WEP_KEYS;
8864
8865 /* Set the Wireless Extension versions */
8866 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008867 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008868
James Ketrenosb095c382005-08-24 22:04:42 -05008869 i = 0;
8870 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008871 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8872 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8873 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8874 continue;
8875
James Ketrenosb095c382005-08-24 22:04:42 -05008876 range->freq[i].i = geo->bg[j].channel;
8877 range->freq[i].m = geo->bg[j].freq * 100000;
8878 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008879 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008880 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008881 }
James Ketrenosb095c382005-08-24 22:04:42 -05008882
8883 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008884 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8885 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8886 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8887 continue;
8888
James Ketrenosb095c382005-08-24 22:04:42 -05008889 range->freq[i].i = geo->a[j].channel;
8890 range->freq[i].m = geo->a[j].freq * 100000;
8891 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008892 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008893 }
8894 }
8895
8896 range->num_channels = i;
8897 range->num_frequency = i;
8898
Zhu Yi46441512006-01-24 16:37:59 +08008899 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008900
8901 /* Event capability (kernel + driver) */
8902 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8903 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008904 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8905 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008906 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008907
Dan Williamsf1b50862006-01-30 13:58:56 -05008908 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8909 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8910
Dan Williams374fdfb2007-12-12 10:25:07 -05008911 range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE;
8912
James Ketrenos43f66a62005-03-25 12:31:53 -06008913 IPW_DEBUG_WX("GET Range\n");
8914 return 0;
8915}
8916
Jeff Garzikbf794512005-07-31 13:07:26 -04008917static int ipw_wx_set_wap(struct net_device *dev,
8918 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008919 union iwreq_data *wrqu, char *extra)
8920{
8921 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07008922 DECLARE_MAC_BUF(mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06008923
8924 static const unsigned char any[] = {
8925 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8926 };
8927 static const unsigned char off[] = {
8928 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8929 };
8930
Jeff Garzikbf794512005-07-31 13:07:26 -04008931 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008932 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008933 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008934 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8935 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8936 /* we disable mandatory BSSID association */
8937 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8938 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008939 IPW_DEBUG_ASSOC("Attempting to associate with new "
8940 "parameters.\n");
8941 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08008942 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008943 return 0;
8944 }
8945
8946 priv->config |= CFG_STATIC_BSSID;
8947 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8948 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008949 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008950 return 0;
8951 }
8952
Joe Perches0795af52007-10-03 17:59:30 -07008953 IPW_DEBUG_WX("Setting mandatory BSSID to %s\n",
8954 print_mac(mac, wrqu->ap_addr.sa_data));
James Ketrenos43f66a62005-03-25 12:31:53 -06008955
8956 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
8957
James Ketrenosc848d0a2005-08-24 21:56:24 -05008958 /* Network configuration changed -- force [re]association */
8959 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
8960 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008961 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008962
Zhu Yi46441512006-01-24 16:37:59 +08008963 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008964 return 0;
8965}
8966
Jeff Garzikbf794512005-07-31 13:07:26 -04008967static int ipw_wx_get_wap(struct net_device *dev,
8968 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008969 union iwreq_data *wrqu, char *extra)
8970{
8971 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07008972 DECLARE_MAC_BUF(mac);
8973
James Ketrenos43f66a62005-03-25 12:31:53 -06008974 /* If we are associated, trying to associate, or have a statically
8975 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008976 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04008977 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06008978 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8979 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008980 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06008981 } else
8982 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8983
Joe Perches0795af52007-10-03 17:59:30 -07008984 IPW_DEBUG_WX("Getting WAP BSSID: %s\n",
8985 print_mac(mac, wrqu->ap_addr.sa_data));
Zhu Yi46441512006-01-24 16:37:59 +08008986 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008987 return 0;
8988}
8989
Jeff Garzikbf794512005-07-31 13:07:26 -04008990static int ipw_wx_set_essid(struct net_device *dev,
8991 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008992 union iwreq_data *wrqu, char *extra)
8993{
8994 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08008995 int length;
James Ketrenos43f66a62005-03-25 12:31:53 -06008996
Zhu Yiab644b02006-08-21 11:37:13 +08008997 mutex_lock(&priv->mutex);
8998
8999 if (!wrqu->essid.flags)
9000 {
9001 IPW_DEBUG_WX("Setting ESSID to ANY\n");
9002 ipw_disassociate(priv);
9003 priv->config &= ~CFG_STATIC_ESSID;
9004 ipw_associate(priv);
9005 mutex_unlock(&priv->mutex);
9006 return 0;
9007 }
9008
Zhu Yia9f0d422006-08-21 11:37:26 +08009009 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06009010
9011 priv->config |= CFG_STATIC_ESSID;
9012
Zhu Yia9f0d422006-08-21 11:37:26 +08009013 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
9014 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009015 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009016 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009017 return 0;
9018 }
9019
Zhu Yiab644b02006-08-21 11:37:13 +08009020 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n", escape_essid(extra, length),
James Ketrenos43f66a62005-03-25 12:31:53 -06009021 length);
9022
9023 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08009024 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04009025
James Ketrenosc848d0a2005-08-24 21:56:24 -05009026 /* Network configuration changed -- force [re]association */
9027 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
9028 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009029 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009030
Zhu Yi46441512006-01-24 16:37:59 +08009031 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009032 return 0;
9033}
9034
Jeff Garzikbf794512005-07-31 13:07:26 -04009035static int ipw_wx_get_essid(struct net_device *dev,
9036 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009037 union iwreq_data *wrqu, char *extra)
9038{
9039 struct ipw_priv *priv = ieee80211_priv(dev);
9040
9041 /* If we are associated, trying to associate, or have a statically
9042 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009043 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009044 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04009045 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9046 IPW_DEBUG_WX("Getting essid: '%s'\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009047 escape_essid(priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04009048 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06009049 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009050 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009051 } else {
9052 IPW_DEBUG_WX("Getting essid: ANY\n");
9053 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009054 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009055 }
Zhu Yi46441512006-01-24 16:37:59 +08009056 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009057 return 0;
9058}
9059
Jeff Garzikbf794512005-07-31 13:07:26 -04009060static int ipw_wx_set_nick(struct net_device *dev,
9061 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009062 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009063{
James Ketrenos43f66a62005-03-25 12:31:53 -06009064 struct ipw_priv *priv = ieee80211_priv(dev);
9065
9066 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
9067 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
9068 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08009069 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009070 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06009071 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009072 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009073 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08009074 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009075 return 0;
9076
9077}
9078
Jeff Garzikbf794512005-07-31 13:07:26 -04009079static int ipw_wx_get_nick(struct net_device *dev,
9080 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009081 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009082{
James Ketrenos43f66a62005-03-25 12:31:53 -06009083 struct ipw_priv *priv = ieee80211_priv(dev);
9084 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08009085 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009086 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06009087 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009088 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08009089 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009090 return 0;
9091}
9092
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009093static int ipw_wx_set_sens(struct net_device *dev,
9094 struct iw_request_info *info,
9095 union iwreq_data *wrqu, char *extra)
9096{
9097 struct ipw_priv *priv = ieee80211_priv(dev);
9098 int err = 0;
9099
9100 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
9101 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
9102 mutex_lock(&priv->mutex);
9103
9104 if (wrqu->sens.fixed == 0)
9105 {
9106 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
9107 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
9108 goto out;
9109 }
9110 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
9111 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
9112 err = -EINVAL;
9113 goto out;
9114 }
9115
9116 priv->roaming_threshold = wrqu->sens.value;
9117 priv->disassociate_threshold = 3*wrqu->sens.value;
9118 out:
9119 mutex_unlock(&priv->mutex);
9120 return err;
9121}
9122
9123static int ipw_wx_get_sens(struct net_device *dev,
9124 struct iw_request_info *info,
9125 union iwreq_data *wrqu, char *extra)
9126{
9127 struct ipw_priv *priv = ieee80211_priv(dev);
9128 mutex_lock(&priv->mutex);
9129 wrqu->sens.fixed = 1;
9130 wrqu->sens.value = priv->roaming_threshold;
9131 mutex_unlock(&priv->mutex);
9132
9133 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9134 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9135
9136 return 0;
9137}
9138
James Ketrenos43f66a62005-03-25 12:31:53 -06009139static int ipw_wx_set_rate(struct net_device *dev,
9140 struct iw_request_info *info,
9141 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009142{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009143 /* TODO: We should use semaphores or locks for access to priv */
9144 struct ipw_priv *priv = ieee80211_priv(dev);
9145 u32 target_rate = wrqu->bitrate.value;
9146 u32 fixed, mask;
9147
9148 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9149 /* value = X, fixed = 1 means only rate X */
9150 /* value = X, fixed = 0 means all rates lower equal X */
9151
9152 if (target_rate == -1) {
9153 fixed = 0;
9154 mask = IEEE80211_DEFAULT_RATES_MASK;
9155 /* Now we should reassociate */
9156 goto apply;
9157 }
9158
9159 mask = 0;
9160 fixed = wrqu->bitrate.fixed;
9161
9162 if (target_rate == 1000000 || !fixed)
9163 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9164 if (target_rate == 1000000)
9165 goto apply;
9166
9167 if (target_rate == 2000000 || !fixed)
9168 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9169 if (target_rate == 2000000)
9170 goto apply;
9171
9172 if (target_rate == 5500000 || !fixed)
9173 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9174 if (target_rate == 5500000)
9175 goto apply;
9176
9177 if (target_rate == 6000000 || !fixed)
9178 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9179 if (target_rate == 6000000)
9180 goto apply;
9181
9182 if (target_rate == 9000000 || !fixed)
9183 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9184 if (target_rate == 9000000)
9185 goto apply;
9186
9187 if (target_rate == 11000000 || !fixed)
9188 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9189 if (target_rate == 11000000)
9190 goto apply;
9191
9192 if (target_rate == 12000000 || !fixed)
9193 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9194 if (target_rate == 12000000)
9195 goto apply;
9196
9197 if (target_rate == 18000000 || !fixed)
9198 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9199 if (target_rate == 18000000)
9200 goto apply;
9201
9202 if (target_rate == 24000000 || !fixed)
9203 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9204 if (target_rate == 24000000)
9205 goto apply;
9206
9207 if (target_rate == 36000000 || !fixed)
9208 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9209 if (target_rate == 36000000)
9210 goto apply;
9211
9212 if (target_rate == 48000000 || !fixed)
9213 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9214 if (target_rate == 48000000)
9215 goto apply;
9216
9217 if (target_rate == 54000000 || !fixed)
9218 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9219 if (target_rate == 54000000)
9220 goto apply;
9221
9222 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9223 return -EINVAL;
9224
9225 apply:
9226 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9227 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009228 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009229 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009230 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009231 ipw_set_fixed_rate(priv, priv->ieee->mode);
9232 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009233 priv->config |= CFG_FIXED_RATE;
9234
James Ketrenosc848d0a2005-08-24 21:56:24 -05009235 if (priv->rates_mask == mask) {
9236 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009237 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009238 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009239 }
9240
James Ketrenosc848d0a2005-08-24 21:56:24 -05009241 priv->rates_mask = mask;
9242
9243 /* Network configuration changed -- force [re]association */
9244 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9245 if (!ipw_disassociate(priv))
9246 ipw_associate(priv);
9247
Zhu Yi46441512006-01-24 16:37:59 +08009248 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009249 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009250}
9251
Jeff Garzikbf794512005-07-31 13:07:26 -04009252static int ipw_wx_get_rate(struct net_device *dev,
9253 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009254 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009255{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009256 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009257 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009258 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009259 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009260 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009261 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9262 return 0;
9263}
9264
Jeff Garzikbf794512005-07-31 13:07:26 -04009265static int ipw_wx_set_rts(struct net_device *dev,
9266 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009267 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009268{
James Ketrenos43f66a62005-03-25 12:31:53 -06009269 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009270 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009271 if (wrqu->rts.disabled || !wrqu->rts.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009272 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9273 else {
9274 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009275 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009276 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009277 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009278 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009279 priv->rts_threshold = wrqu->rts.value;
9280 }
9281
9282 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009283 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009284 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9285 return 0;
9286}
9287
Jeff Garzikbf794512005-07-31 13:07:26 -04009288static int ipw_wx_get_rts(struct net_device *dev,
9289 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009290 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009291{
James Ketrenos43f66a62005-03-25 12:31:53 -06009292 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009293 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009294 wrqu->rts.value = priv->rts_threshold;
9295 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009296 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009297 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009298 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9299 return 0;
9300}
9301
Jeff Garzikbf794512005-07-31 13:07:26 -04009302static int ipw_wx_set_txpow(struct net_device *dev,
9303 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009304 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009305{
James Ketrenos43f66a62005-03-25 12:31:53 -06009306 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009307 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009308
Zhu Yi46441512006-01-24 16:37:59 +08009309 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009310 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009311 err = -EINPROGRESS;
9312 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009313 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009314
James Ketrenosb095c382005-08-24 22:04:42 -05009315 if (!wrqu->power.fixed)
9316 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009317
James Ketrenosc848d0a2005-08-24 21:56:24 -05009318 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009319 err = -EINVAL;
9320 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009321 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009322
James Ketrenosb095c382005-08-24 22:04:42 -05009323 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009324 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009325 err = -EINVAL;
9326 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009327 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009328
9329 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009330 err = ipw_set_tx_power(priv);
9331 out:
Zhu Yi46441512006-01-24 16:37:59 +08009332 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009333 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009334}
9335
Jeff Garzikbf794512005-07-31 13:07:26 -04009336static int ipw_wx_get_txpow(struct net_device *dev,
9337 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009338 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009339{
James Ketrenos43f66a62005-03-25 12:31:53 -06009340 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009341 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009342 wrqu->power.value = priv->tx_power;
9343 wrqu->power.fixed = 1;
9344 wrqu->power.flags = IW_TXPOW_DBM;
9345 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009346 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009347
Jeff Garzikbf794512005-07-31 13:07:26 -04009348 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009349 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009350
9351 return 0;
9352}
9353
Jeff Garzikbf794512005-07-31 13:07:26 -04009354static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009355 struct iw_request_info *info,
9356 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009357{
9358 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009359 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009360 if (wrqu->frag.disabled || !wrqu->frag.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009361 priv->ieee->fts = DEFAULT_FTS;
9362 else {
9363 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009364 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009365 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009366 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009367 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009368
James Ketrenos43f66a62005-03-25 12:31:53 -06009369 priv->ieee->fts = wrqu->frag.value & ~0x1;
9370 }
9371
9372 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009373 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009374 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9375 return 0;
9376}
9377
Jeff Garzikbf794512005-07-31 13:07:26 -04009378static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009379 struct iw_request_info *info,
9380 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009381{
9382 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009383 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009384 wrqu->frag.value = priv->ieee->fts;
9385 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009386 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009387 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009388 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9389
9390 return 0;
9391}
9392
Jeff Garzikbf794512005-07-31 13:07:26 -04009393static int ipw_wx_set_retry(struct net_device *dev,
9394 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009395 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009396{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009397 struct ipw_priv *priv = ieee80211_priv(dev);
9398
9399 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9400 return -EINVAL;
9401
9402 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9403 return 0;
9404
Zhu Yid5f7ac22006-08-21 11:38:17 +08009405 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009406 return -EINVAL;
9407
Zhu Yi46441512006-01-24 16:37:59 +08009408 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009409 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009410 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009411 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009412 priv->long_retry_limit = (u8) wrqu->retry.value;
9413 else {
9414 priv->short_retry_limit = (u8) wrqu->retry.value;
9415 priv->long_retry_limit = (u8) wrqu->retry.value;
9416 }
9417
9418 ipw_send_retry_limit(priv, priv->short_retry_limit,
9419 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009420 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009421 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9422 priv->short_retry_limit, priv->long_retry_limit);
9423 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009424}
9425
Jeff Garzikbf794512005-07-31 13:07:26 -04009426static int ipw_wx_get_retry(struct net_device *dev,
9427 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009428 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009429{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009430 struct ipw_priv *priv = ieee80211_priv(dev);
9431
Zhu Yi46441512006-01-24 16:37:59 +08009432 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009433 wrqu->retry.disabled = 0;
9434
9435 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009436 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009437 return -EINVAL;
9438 }
9439
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009440 if (wrqu->retry.flags & IW_RETRY_LONG) {
9441 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009442 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009443 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9444 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009445 wrqu->retry.value = priv->short_retry_limit;
9446 } else {
9447 wrqu->retry.flags = IW_RETRY_LIMIT;
9448 wrqu->retry.value = priv->short_retry_limit;
9449 }
Zhu Yi46441512006-01-24 16:37:59 +08009450 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009451
9452 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9453
9454 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009455}
9456
James Ketrenosafbf30a2005-08-25 00:05:33 -05009457static int ipw_request_direct_scan(struct ipw_priv *priv, char *essid,
9458 int essid_len)
9459{
9460 struct ipw_scan_request_ext scan;
9461 int err = 0, scan_type;
9462
Pekka Enbergefb34422005-11-16 21:55:05 +02009463 if (!(priv->status & STATUS_INIT) ||
9464 (priv->status & STATUS_EXIT_PENDING))
9465 return 0;
9466
Zhu Yi46441512006-01-24 16:37:59 +08009467 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009468
9469 if (priv->status & STATUS_RF_KILL_MASK) {
9470 IPW_DEBUG_HC("Aborting scan due to RF kill activation\n");
9471 priv->status |= STATUS_SCAN_PENDING;
9472 goto done;
9473 }
9474
9475 IPW_DEBUG_HC("starting request direct scan!\n");
9476
9477 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
Olaf Kirchd834a412006-01-09 17:00:37 +01009478 /* We should not sleep here; otherwise we will block most
9479 * of the system (for instance, we hold rtnl_lock when we
9480 * get here).
9481 */
9482 err = -EAGAIN;
9483 goto done;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009484 }
9485 memset(&scan, 0, sizeof(scan));
9486
9487 if (priv->config & CFG_SPEED_SCAN)
9488 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9489 cpu_to_le16(30);
9490 else
9491 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9492 cpu_to_le16(20);
9493
9494 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
9495 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05009496 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009497 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
9498
9499 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
9500
9501 err = ipw_send_ssid(priv, essid, essid_len);
9502 if (err) {
9503 IPW_DEBUG_HC("Attempt to send SSID command failed\n");
9504 goto done;
9505 }
9506 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
9507
9508 ipw_add_scan_channels(priv, &scan, scan_type);
9509
9510 err = ipw_send_scan_request_ext(priv, &scan);
9511 if (err) {
9512 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
9513 goto done;
9514 }
9515
9516 priv->status |= STATUS_SCANNING;
9517
9518 done:
Zhu Yi46441512006-01-24 16:37:59 +08009519 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009520 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009521}
9522
Jeff Garzikbf794512005-07-31 13:07:26 -04009523static int ipw_wx_set_scan(struct net_device *dev,
9524 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009525 union iwreq_data *wrqu, char *extra)
9526{
9527 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009528 struct iw_scan_req *req = (struct iw_scan_req *)extra;
9529
Dan Williams0b531672007-10-09 13:55:24 -04009530 mutex_lock(&priv->mutex);
9531 priv->user_requested_scan = 1;
9532 mutex_unlock(&priv->mutex);
9533
Zhu Yi094c4d22006-08-21 11:39:03 +08009534 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009535 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
9536 ipw_request_direct_scan(priv, req->essid,
9537 req->essid_len);
9538 return 0;
9539 }
Zhu Yi094c4d22006-08-21 11:39:03 +08009540 if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9541 queue_work(priv->workqueue,
9542 &priv->request_passive_scan);
9543 return 0;
9544 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05009545 }
James Ketrenos8935f392005-10-05 15:59:08 -05009546
James Ketrenos43f66a62005-03-25 12:31:53 -06009547 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009548
David Howellsc4028952006-11-22 14:57:56 +00009549 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05009550
James Ketrenos43f66a62005-03-25 12:31:53 -06009551 return 0;
9552}
9553
Jeff Garzikbf794512005-07-31 13:07:26 -04009554static int ipw_wx_get_scan(struct net_device *dev,
9555 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009556 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009557{
James Ketrenos43f66a62005-03-25 12:31:53 -06009558 struct ipw_priv *priv = ieee80211_priv(dev);
9559 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9560}
9561
Jeff Garzikbf794512005-07-31 13:07:26 -04009562static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009563 struct iw_request_info *info,
9564 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009565{
9566 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009567 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009568 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009569
Zhu Yi46441512006-01-24 16:37:59 +08009570 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009571 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009572
Hong Liucaeff812005-08-05 17:25:50 +08009573 /* In IBSS mode, we need to notify the firmware to update
9574 * the beacon info after we changed the capability. */
9575 if (cap != priv->capability &&
9576 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9577 priv->status & STATUS_ASSOCIATED)
9578 ipw_disassociate(priv);
9579
Zhu Yi46441512006-01-24 16:37:59 +08009580 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009581 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009582}
9583
Jeff Garzikbf794512005-07-31 13:07:26 -04009584static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009585 struct iw_request_info *info,
9586 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009587{
9588 struct ipw_priv *priv = ieee80211_priv(dev);
9589 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9590}
9591
Jeff Garzikbf794512005-07-31 13:07:26 -04009592static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009593 struct iw_request_info *info,
9594 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009595{
9596 struct ipw_priv *priv = ieee80211_priv(dev);
9597 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009598 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009599 if (wrqu->power.disabled) {
9600 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9601 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9602 if (err) {
9603 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009604 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009605 return err;
9606 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009607 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009608 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009609 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009610 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009611
9612 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009613 case IW_POWER_ON: /* If not specified */
9614 case IW_POWER_MODE: /* If set all mask */
Jean Delvarec03983a2007-10-19 23:22:55 +02009615 case IW_POWER_ALL_R: /* If explicitly state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009616 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009617 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009618 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9619 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009620 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009621 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009622 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009623
James Ketrenos43f66a62005-03-25 12:31:53 -06009624 /* If the user hasn't specified a power management mode yet, default
9625 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009626 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009627 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009628 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009629 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
Zhu Yi4e157f02007-07-12 16:09:32 +08009630
James Ketrenos43f66a62005-03-25 12:31:53 -06009631 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9632 if (err) {
9633 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009634 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009635 return err;
9636 }
9637
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009638 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009639 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009640 return 0;
9641}
9642
Jeff Garzikbf794512005-07-31 13:07:26 -04009643static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009644 struct iw_request_info *info,
9645 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009646{
9647 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009648 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009649 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009650 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009651 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009652 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009653
Zhu Yi46441512006-01-24 16:37:59 +08009654 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009655 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009656
James Ketrenos43f66a62005-03-25 12:31:53 -06009657 return 0;
9658}
9659
Jeff Garzikbf794512005-07-31 13:07:26 -04009660static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009661 struct iw_request_info *info,
9662 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009663{
9664 struct ipw_priv *priv = ieee80211_priv(dev);
9665 int mode = *(int *)extra;
9666 int err;
Zhu Yi4e157f02007-07-12 16:09:32 +08009667
Zhu Yi46441512006-01-24 16:37:59 +08009668 mutex_lock(&priv->mutex);
Zhu Yi4e157f02007-07-12 16:09:32 +08009669 if ((mode < 1) || (mode > IPW_POWER_LIMIT))
James Ketrenos43f66a62005-03-25 12:31:53 -06009670 mode = IPW_POWER_AC;
Jeff Garzikbf794512005-07-31 13:07:26 -04009671
Zhu Yi4e157f02007-07-12 16:09:32 +08009672 if (IPW_POWER_LEVEL(priv->power_mode) != mode) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009673 err = ipw_send_power_mode(priv, mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009674 if (err) {
9675 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009676 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009677 return err;
9678 }
Zhu Yi4e157f02007-07-12 16:09:32 +08009679 priv->power_mode = IPW_POWER_ENABLED | mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06009680 }
Zhu Yi46441512006-01-24 16:37:59 +08009681 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009682 return 0;
9683}
9684
9685#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009686static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009687 struct iw_request_info *info,
9688 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009689{
9690 struct ipw_priv *priv = ieee80211_priv(dev);
9691 int level = IPW_POWER_LEVEL(priv->power_mode);
9692 char *p = extra;
9693
9694 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9695
9696 switch (level) {
9697 case IPW_POWER_AC:
9698 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9699 break;
9700 case IPW_POWER_BATTERY:
9701 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9702 break;
9703 default:
9704 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009705 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009706 timeout_duration[level - 1] / 1000,
9707 period_duration[level - 1] / 1000);
9708 }
9709
9710 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009711 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009712
9713 wrqu->data.length = p - extra + 1;
9714
9715 return 0;
9716}
9717
9718static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009719 struct iw_request_info *info,
9720 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009721{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009722 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009723 int mode = *(int *)extra;
9724 u8 band = 0, modulation = 0;
9725
9726 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009727 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009728 return -EINVAL;
9729 }
Zhu Yi46441512006-01-24 16:37:59 +08009730 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009731 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009732 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009733 if (mode & IEEE_A) {
9734 band |= IEEE80211_52GHZ_BAND;
9735 modulation |= IEEE80211_OFDM_MODULATION;
9736 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009737 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009738 } else {
9739 if (mode & IEEE_A) {
9740 IPW_WARNING("Attempt to set 2200BG into "
9741 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009742 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009743 return -EINVAL;
9744 }
9745
James Ketrenosa33a1982005-09-14 14:28:59 -05009746 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009747 }
9748
9749 if (mode & IEEE_B) {
9750 band |= IEEE80211_24GHZ_BAND;
9751 modulation |= IEEE80211_CCK_MODULATION;
9752 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009753 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009754
James Ketrenos43f66a62005-03-25 12:31:53 -06009755 if (mode & IEEE_G) {
9756 band |= IEEE80211_24GHZ_BAND;
9757 modulation |= IEEE80211_OFDM_MODULATION;
9758 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009759 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009760
9761 priv->ieee->mode = mode;
9762 priv->ieee->freq_band = band;
9763 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009764 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009765
James Ketrenosc848d0a2005-08-24 21:56:24 -05009766 /* Network configuration changed -- force [re]association */
9767 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9768 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009769 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009770 ipw_associate(priv);
9771 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009772
James Ketrenosa613bff2005-08-24 21:43:11 -05009773 /* Update the band LEDs */
9774 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009775
Jeff Garzikbf794512005-07-31 13:07:26 -04009776 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009777 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009778 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009779 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009780 return 0;
9781}
9782
9783static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009784 struct iw_request_info *info,
9785 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009786{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009787 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009788 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009789 switch (priv->ieee->mode) {
9790 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009791 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9792 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009793 case IEEE_B:
9794 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9795 break;
9796 case IEEE_A | IEEE_B:
9797 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9798 break;
9799 case IEEE_G:
9800 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9801 break;
9802 case IEEE_A | IEEE_G:
9803 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9804 break;
9805 case IEEE_B | IEEE_G:
9806 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9807 break;
9808 case IEEE_A | IEEE_B | IEEE_G:
9809 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9810 break;
9811 default:
9812 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009813 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009814 }
9815
James Ketrenos43f66a62005-03-25 12:31:53 -06009816 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9817
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009818 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009819 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009820
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009821 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009822}
9823
James Ketrenosea2b26e2005-08-24 21:25:16 -05009824static int ipw_wx_set_preamble(struct net_device *dev,
9825 struct iw_request_info *info,
9826 union iwreq_data *wrqu, char *extra)
9827{
9828 struct ipw_priv *priv = ieee80211_priv(dev);
9829 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009830 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009831 /* Switching from SHORT -> LONG requires a disassociation */
9832 if (mode == 1) {
9833 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9834 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009835
9836 /* Network configuration changed -- force [re]association */
9837 IPW_DEBUG_ASSOC
9838 ("[re]association triggered due to preamble change.\n");
9839 if (!ipw_disassociate(priv))
9840 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009841 }
9842 goto done;
9843 }
9844
9845 if (mode == 0) {
9846 priv->config &= ~CFG_PREAMBLE_LONG;
9847 goto done;
9848 }
Zhu Yi46441512006-01-24 16:37:59 +08009849 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009850 return -EINVAL;
9851
9852 done:
Zhu Yi46441512006-01-24 16:37:59 +08009853 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009854 return 0;
9855}
9856
9857static int ipw_wx_get_preamble(struct net_device *dev,
9858 struct iw_request_info *info,
9859 union iwreq_data *wrqu, char *extra)
9860{
9861 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009862 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009863 if (priv->config & CFG_PREAMBLE_LONG)
9864 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9865 else
9866 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009867 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009868 return 0;
9869}
9870
James Ketrenosb095c382005-08-24 22:04:42 -05009871#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009872static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009873 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009874 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009875{
James Ketrenos43f66a62005-03-25 12:31:53 -06009876 struct ipw_priv *priv = ieee80211_priv(dev);
9877 int *parms = (int *)extra;
9878 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009879 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009880 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009881 if (enable) {
9882 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009883#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009884 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9885#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009886 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009887#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009888 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009889 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009890
James Ketrenos43f66a62005-03-25 12:31:53 -06009891 ipw_set_channel(priv, parms[1]);
9892 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009893 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009894 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009895 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009896 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009897 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009898 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009899 }
Zhu Yi46441512006-01-24 16:37:59 +08009900 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009901 return 0;
9902}
9903
Pavel Machek67fd6b42006-07-11 15:34:05 +02009904#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009905
Jeff Garzikbf794512005-07-31 13:07:26 -04009906static int ipw_wx_reset(struct net_device *dev,
9907 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009908 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009909{
James Ketrenos43f66a62005-03-25 12:31:53 -06009910 struct ipw_priv *priv = ieee80211_priv(dev);
9911 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009912 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009913 return 0;
9914}
James Ketrenosb095c382005-08-24 22:04:42 -05009915
James Ketrenosb095c382005-08-24 22:04:42 -05009916static int ipw_wx_sw_reset(struct net_device *dev,
9917 struct iw_request_info *info,
9918 union iwreq_data *wrqu, char *extra)
9919{
9920 struct ipw_priv *priv = ieee80211_priv(dev);
9921 union iwreq_data wrqu_sec = {
9922 .encoding = {
9923 .flags = IW_ENCODE_DISABLED,
9924 },
9925 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009926 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009927
9928 IPW_DEBUG_WX("SW_RESET\n");
9929
Zhu Yi46441512006-01-24 16:37:59 +08009930 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009931
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009932 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009933 if (!ret) {
9934 free_firmware();
9935 ipw_adapter_restart(priv);
9936 }
James Ketrenosb095c382005-08-24 22:04:42 -05009937
9938 /* The SW reset bit might have been toggled on by the 'disable'
9939 * module parameter, so take appropriate action */
9940 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9941
Zhu Yi46441512006-01-24 16:37:59 +08009942 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009943 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009944 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009945
9946 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9947 /* Configuration likely changed -- force [re]association */
9948 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9949 "reset.\n");
9950 if (!ipw_disassociate(priv))
9951 ipw_associate(priv);
9952 }
9953
Zhu Yi46441512006-01-24 16:37:59 +08009954 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009955
9956 return 0;
9957}
James Ketrenos43f66a62005-03-25 12:31:53 -06009958
9959/* Rebase the WE IOCTLs to zero for the handler array */
9960#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009961static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009962 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9963 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9964 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9965 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9966 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009967 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9968 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009969 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9970 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9971 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9972 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9973 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9974 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9975 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9976 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9977 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9978 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9979 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9980 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9981 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9982 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9983 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9984 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9985 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9986 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9987 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9988 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9989 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9990 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9991 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009992 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9993 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9994 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9995 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009996 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9997 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
9998 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
9999 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
10000 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
10001 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
10002 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -060010003};
10004
James Ketrenosb095c382005-08-24 22:04:42 -050010005enum {
10006 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
10007 IPW_PRIV_GET_POWER,
10008 IPW_PRIV_SET_MODE,
10009 IPW_PRIV_GET_MODE,
10010 IPW_PRIV_SET_PREAMBLE,
10011 IPW_PRIV_GET_PREAMBLE,
10012 IPW_PRIV_RESET,
10013 IPW_PRIV_SW_RESET,
10014#ifdef CONFIG_IPW2200_MONITOR
10015 IPW_PRIV_SET_MONITOR,
10016#endif
10017};
James Ketrenos43f66a62005-03-25 12:31:53 -060010018
Jeff Garzikbf794512005-07-31 13:07:26 -040010019static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -060010020 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010021 .cmd = IPW_PRIV_SET_POWER,
10022 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10023 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010024 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010025 .cmd = IPW_PRIV_GET_POWER,
10026 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10027 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010028 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010029 .cmd = IPW_PRIV_SET_MODE,
10030 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10031 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010032 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010033 .cmd = IPW_PRIV_GET_MODE,
10034 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10035 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010036 {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010037 .cmd = IPW_PRIV_SET_PREAMBLE,
10038 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10039 .name = "set_preamble"},
10040 {
10041 .cmd = IPW_PRIV_GET_PREAMBLE,
10042 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
10043 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010044 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010045 IPW_PRIV_RESET,
10046 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -050010047 {
10048 IPW_PRIV_SW_RESET,
10049 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
10050#ifdef CONFIG_IPW2200_MONITOR
10051 {
10052 IPW_PRIV_SET_MONITOR,
10053 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
10054#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -060010055};
10056
10057static iw_handler ipw_priv_handler[] = {
10058 ipw_wx_set_powermode,
10059 ipw_wx_get_powermode,
10060 ipw_wx_set_wireless_mode,
10061 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -050010062 ipw_wx_set_preamble,
10063 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -040010064 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -050010065 ipw_wx_sw_reset,
10066#ifdef CONFIG_IPW2200_MONITOR
10067 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -060010068#endif
10069};
10070
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010071static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010072 .standard = ipw_wx_handlers,
10073 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
10074 .num_private = ARRAY_SIZE(ipw_priv_handler),
10075 .num_private_args = ARRAY_SIZE(ipw_priv_args),
10076 .private = ipw_priv_handler,
10077 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000010078 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -060010079};
10080
James Ketrenos43f66a62005-03-25 12:31:53 -060010081/*
10082 * Get wireless statistics.
10083 * Called by /proc/net/wireless
10084 * Also called by SIOCGIWSTATS
10085 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010086static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -060010087{
10088 struct ipw_priv *priv = ieee80211_priv(dev);
10089 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010090
James Ketrenos43f66a62005-03-25 12:31:53 -060010091 wstats = &priv->wstats;
10092
James Ketrenosea2b26e2005-08-24 21:25:16 -050010093 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -050010094 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -060010095 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
10096 * and associated; if not associcated, the values are all meaningless
10097 * anyway, so set them all to NULL and INVALID */
10098 if (!(priv->status & STATUS_ASSOCIATED)) {
10099 wstats->miss.beacon = 0;
10100 wstats->discard.retries = 0;
10101 wstats->qual.qual = 0;
10102 wstats->qual.level = 0;
10103 wstats->qual.noise = 0;
10104 wstats->qual.updated = 7;
10105 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010106 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -060010107 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010108 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010109
10110 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +080010111 wstats->qual.level = priv->exp_avg_rssi;
10112 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -060010113 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +080010114 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010115
10116 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
10117 wstats->discard.retries = priv->last_tx_failures;
10118 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -040010119
James Ketrenos43f66a62005-03-25 12:31:53 -060010120/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
10121 goto fail_get_ordinal;
10122 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -040010123
James Ketrenos43f66a62005-03-25 12:31:53 -060010124 return wstats;
10125}
10126
James Ketrenos43f66a62005-03-25 12:31:53 -060010127/* net device stuff */
10128
Arjan van de Ven858119e2006-01-14 13:20:43 -080010129static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -060010130{
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010131 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +080010132 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010133 sys_config->answer_broadcast_ssid_probe = 0;
10134 sys_config->accept_all_data_frames = 0;
10135 sys_config->accept_non_directed_frames = 1;
10136 sys_config->exclude_unicast_unencrypted = 0;
10137 sys_config->disable_unicast_decryption = 1;
10138 sys_config->exclude_multicast_unencrypted = 0;
10139 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010140 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10141 antenna = CFG_SYS_ANTENNA_BOTH;
10142 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010143 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010144 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010145 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010146 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010147 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010148 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010149}
10150
10151static int ipw_net_open(struct net_device *dev)
10152{
10153 struct ipw_priv *priv = ieee80211_priv(dev);
10154 IPW_DEBUG_INFO("dev->open\n");
10155 /* we should be verifying the device is ready to be opened */
Zhu Yi46441512006-01-24 16:37:59 +080010156 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -040010157 if (!(priv->status & STATUS_RF_KILL_MASK) &&
10158 (priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -060010159 netif_start_queue(dev);
Zhu Yi46441512006-01-24 16:37:59 +080010160 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010161 return 0;
10162}
10163
10164static int ipw_net_stop(struct net_device *dev)
10165{
10166 IPW_DEBUG_INFO("dev->close\n");
10167 netif_stop_queue(dev);
10168 return 0;
10169}
10170
10171/*
10172todo:
10173
10174modify to send one tfd per fragment instead of using chunking. otherwise
10175we need to heavily modify the ieee80211_skb_to_txb.
10176*/
10177
Arjan van de Ven858119e2006-01-14 13:20:43 -080010178static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010179 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010180{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010181 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010182 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010183 int i = 0;
10184 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010185#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010186 int tx_id = ipw_get_tx_queue_number(priv, pri);
10187 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10188#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010189 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010190#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010191 struct clx2_queue *q = &txq->q;
10192 u8 id, hdr_len, unicast;
10193 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010194 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010195
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010196 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010197 switch (priv->ieee->iw_mode) {
10198 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010199 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010200 id = ipw_find_station(priv, hdr->addr1);
10201 if (id == IPW_INVALID_STATION) {
10202 id = ipw_add_station(priv, hdr->addr1);
10203 if (id == IPW_INVALID_STATION) {
10204 IPW_WARNING("Attempt to send data to "
David S. Miller21f644f2008-04-08 16:50:44 -070010205 "invalid cell: " MAC_FMT "\n",
10206 hdr->addr1[0], hdr->addr1[1],
10207 hdr->addr1[2], hdr->addr1[3],
10208 hdr->addr1[4], hdr->addr1[5]);
James Ketrenos43f66a62005-03-25 12:31:53 -060010209 goto drop;
10210 }
10211 }
10212 break;
10213
10214 case IW_MODE_INFRA:
10215 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010216 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010217 id = 0;
10218 break;
10219 }
10220
10221 tfd = &txq->bd[q->first_empty];
10222 txq->txb[q->first_empty] = txb;
10223 memset(tfd, 0, sizeof(*tfd));
10224 tfd->u.data.station_number = id;
10225
10226 tfd->control_flags.message_type = TX_FRAME_TYPE;
10227 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10228
10229 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010230 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010231 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010232
James Ketrenos43f66a62005-03-25 12:31:53 -060010233 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010234 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010235 else
James Ketrenosb095c382005-08-24 22:04:42 -050010236 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010237
James Ketrenosea2b26e2005-08-24 21:25:16 -050010238 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10239 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010240
James Ketrenosc848d0a2005-08-24 21:56:24 -050010241 fc = le16_to_cpu(hdr->frame_ctl);
10242 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010243
10244 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10245
James Ketrenosb095c382005-08-24 22:04:42 -050010246 if (likely(unicast))
10247 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10248
10249 if (txb->encrypted && !priv->ieee->host_encrypt) {
10250 switch (priv->ieee->sec.level) {
10251 case SEC_LEVEL_3:
10252 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010253 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010254 /* XXX: ACK flag must be set for CCMP even if it
10255 * is a multicast/broadcast packet, because CCMP
10256 * group communication encrypted by GTK is
10257 * actually done by the AP. */
10258 if (!unicast)
10259 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10260
10261 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10262 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10263 tfd->u.data.key_index = 0;
10264 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10265 break;
10266 case SEC_LEVEL_2:
10267 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010268 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010269 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10270 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10271 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10272 break;
10273 case SEC_LEVEL_1:
10274 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010275 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010276 tfd->u.data.key_index = priv->ieee->tx_keyidx;
10277 if (priv->ieee->sec.key_sizes[priv->ieee->tx_keyidx] <=
10278 40)
10279 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10280 else
10281 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10282 break;
10283 case SEC_LEVEL_0:
10284 break;
10285 default:
10286 printk(KERN_ERR "Unknow security level %d\n",
10287 priv->ieee->sec.level);
10288 break;
10289 }
10290 } else
10291 /* No hardware encryption */
10292 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10293
Zhu Yie43e3c12006-04-13 17:20:45 +080010294#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010295 if (fc & IEEE80211_STYPE_QOS_DATA)
10296 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010297#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010298
James Ketrenos43f66a62005-03-25 12:31:53 -060010299 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010300 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10301 txb->nr_frags));
10302 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10303 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10304 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10305 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10306 i, le32_to_cpu(tfd->u.data.num_chunks),
10307 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010308 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010309 i, tfd->u.data.num_chunks,
10310 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010311 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010312 txb->fragments[i]->len - hdr_len);
10313
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010314 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010315 cpu_to_le32(pci_map_single
10316 (priv->pci_dev,
10317 txb->fragments[i]->data + hdr_len,
10318 txb->fragments[i]->len - hdr_len,
10319 PCI_DMA_TODEVICE));
10320 tfd->u.data.chunk_len[i] =
10321 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010322 }
10323
10324 if (i != txb->nr_frags) {
10325 struct sk_buff *skb;
10326 u16 remaining_bytes = 0;
10327 int j;
10328
10329 for (j = i; j < txb->nr_frags; j++)
10330 remaining_bytes += txb->fragments[j]->len - hdr_len;
10331
10332 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10333 remaining_bytes);
10334 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10335 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010336 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010337 for (j = i; j < txb->nr_frags; j++) {
10338 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010339
James Ketrenos43f66a62005-03-25 12:31:53 -060010340 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010341 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010342 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010343 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010344 }
10345 dev_kfree_skb_any(txb->fragments[i]);
10346 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010347 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010348 cpu_to_le32(pci_map_single
10349 (priv->pci_dev, skb->data,
Al Viro49587302007-12-27 01:57:47 -050010350 remaining_bytes,
James Ketrenosa613bff2005-08-24 21:43:11 -050010351 PCI_DMA_TODEVICE));
10352
10353 tfd->u.data.num_chunks =
10354 cpu_to_le32(le32_to_cpu(tfd->u.data.num_chunks) +
10355 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010356 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010357 }
10358
10359 /* kick DMA */
10360 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10361 ipw_write32(priv, q->reg_w, q->first_empty);
10362
Dan Williams943dbef2008-02-14 17:49:41 -050010363 if (ipw_tx_queue_space(q) < q->high_mark)
James Ketrenosf6970142006-02-14 09:10:51 +080010364 netif_stop_queue(priv->net_dev);
10365
James Ketrenos227d2dc2005-07-28 16:25:55 -050010366 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010367
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010368 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010369 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10370 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010371 return NETDEV_TX_OK;
10372}
10373
10374static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10375{
10376 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010377#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010378 int tx_id = ipw_get_tx_queue_number(priv, pri);
10379 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10380#else
10381 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010382#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010383
Dan Williams943dbef2008-02-14 17:49:41 -050010384 if (ipw_tx_queue_space(&txq->q) < txq->q.high_mark)
James Ketrenos227d2dc2005-07-28 16:25:55 -050010385 return 1;
10386
10387 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010388}
10389
Zhu Yid685b8c2006-04-13 17:20:27 +080010390#ifdef CONFIG_IPW2200_PROMISCUOUS
10391static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10392 struct ieee80211_txb *txb)
10393{
10394 struct ieee80211_rx_stats dummystats;
10395 struct ieee80211_hdr *hdr;
10396 u8 n;
10397 u16 filter = priv->prom_priv->filter;
10398 int hdr_only = 0;
10399
10400 if (filter & IPW_PROM_NO_TX)
10401 return;
10402
10403 memset(&dummystats, 0, sizeof(dummystats));
10404
10405 /* Filtering of fragment chains is done agains the first fragment */
10406 hdr = (void *)txb->fragments[0]->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010407 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010408 if (filter & IPW_PROM_NO_MGMT)
10409 return;
10410 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10411 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010412 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010413 if (filter & IPW_PROM_NO_CTL)
10414 return;
10415 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10416 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010417 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010418 if (filter & IPW_PROM_NO_DATA)
10419 return;
10420 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10421 hdr_only = 1;
10422 }
10423
10424 for(n=0; n<txb->nr_frags; ++n) {
10425 struct sk_buff *src = txb->fragments[n];
10426 struct sk_buff *dst;
10427 struct ieee80211_radiotap_header *rt_hdr;
10428 int len;
10429
10430 if (hdr_only) {
10431 hdr = (void *)src->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010432 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +080010433 } else
10434 len = src->len;
10435
10436 dst = alloc_skb(
10437 len + IEEE80211_RADIOTAP_HDRLEN, GFP_ATOMIC);
10438 if (!dst) continue;
10439
10440 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10441
10442 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10443 rt_hdr->it_pad = 0;
10444 rt_hdr->it_present = 0; /* after all, it's just an idea */
Al Viro743b84d2007-12-27 01:43:16 -050010445 rt_hdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_CHANNEL);
Zhu Yid685b8c2006-04-13 17:20:27 +080010446
Al Viroe62e1ee2007-12-27 01:36:46 -050010447 *(__le16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
Zhu Yid685b8c2006-04-13 17:20:27 +080010448 ieee80211chan2mhz(priv->channel));
10449 if (priv->channel > 14) /* 802.11a */
Al Viroe62e1ee2007-12-27 01:36:46 -050010450 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010451 cpu_to_le16(IEEE80211_CHAN_OFDM |
10452 IEEE80211_CHAN_5GHZ);
10453 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
Al Viroe62e1ee2007-12-27 01:36:46 -050010454 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010455 cpu_to_le16(IEEE80211_CHAN_CCK |
10456 IEEE80211_CHAN_2GHZ);
10457 else /* 802.11g */
Al Viroe62e1ee2007-12-27 01:36:46 -050010458 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010459 cpu_to_le16(IEEE80211_CHAN_OFDM |
10460 IEEE80211_CHAN_2GHZ);
10461
Al Viro743b84d2007-12-27 01:43:16 -050010462 rt_hdr->it_len = cpu_to_le16(dst->len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010463
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -030010464 skb_copy_from_linear_data(src, skb_put(dst, len), len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010465
10466 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10467 dev_kfree_skb_any(dst);
10468 }
10469}
10470#endif
10471
James Ketrenos43f66a62005-03-25 12:31:53 -060010472static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010473 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010474{
10475 struct ipw_priv *priv = ieee80211_priv(dev);
10476 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010477 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010478
10479 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010480 spin_lock_irqsave(&priv->lock, flags);
10481
10482 if (!(priv->status & STATUS_ASSOCIATED)) {
10483 IPW_DEBUG_INFO("Tx attempt while not associated.\n");
10484 priv->ieee->stats.tx_carrier_errors++;
10485 netif_stop_queue(dev);
10486 goto fail_unlock;
10487 }
10488
Zhu Yid685b8c2006-04-13 17:20:27 +080010489#ifdef CONFIG_IPW2200_PROMISCUOUS
10490 if (rtap_iface && netif_running(priv->prom_net_dev))
10491 ipw_handle_promiscuous_tx(priv, txb);
10492#endif
10493
James Ketrenos227d2dc2005-07-28 16:25:55 -050010494 ret = ipw_tx_skb(priv, txb, pri);
10495 if (ret == NETDEV_TX_OK)
10496 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010497 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010498
James Ketrenos227d2dc2005-07-28 16:25:55 -050010499 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010500
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010501 fail_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010502 spin_unlock_irqrestore(&priv->lock, flags);
10503 return 1;
10504}
10505
10506static struct net_device_stats *ipw_net_get_stats(struct net_device *dev)
10507{
10508 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzikbf794512005-07-31 13:07:26 -040010509
James Ketrenos43f66a62005-03-25 12:31:53 -060010510 priv->ieee->stats.tx_packets = priv->tx_packets;
10511 priv->ieee->stats.rx_packets = priv->rx_packets;
10512 return &priv->ieee->stats;
10513}
10514
10515static void ipw_net_set_multicast_list(struct net_device *dev)
10516{
10517
10518}
10519
10520static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10521{
10522 struct ipw_priv *priv = ieee80211_priv(dev);
10523 struct sockaddr *addr = p;
Joe Perches0795af52007-10-03 17:59:30 -070010524 DECLARE_MAC_BUF(mac);
10525
James Ketrenos43f66a62005-03-25 12:31:53 -060010526 if (!is_valid_ether_addr(addr->sa_data))
10527 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010528 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010529 priv->config |= CFG_CUSTOM_MAC;
10530 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
Joe Perches0795af52007-10-03 17:59:30 -070010531 printk(KERN_INFO "%s: Setting MAC to %s\n",
10532 priv->net_dev->name, print_mac(mac, priv->mac_addr));
James Ketrenosa613bff2005-08-24 21:43:11 -050010533 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010534 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010535 return 0;
10536}
10537
Jeff Garzikbf794512005-07-31 13:07:26 -040010538static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010539 struct ethtool_drvinfo *info)
10540{
10541 struct ipw_priv *p = ieee80211_priv(dev);
10542 char vers[64];
10543 char date[32];
10544 u32 len;
10545
10546 strcpy(info->driver, DRV_NAME);
10547 strcpy(info->version, DRV_VERSION);
10548
10549 len = sizeof(vers);
10550 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10551 len = sizeof(date);
10552 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10553
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010554 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010555 vers, date);
10556 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010557 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010558}
10559
10560static u32 ipw_ethtool_get_link(struct net_device *dev)
10561{
10562 struct ipw_priv *priv = ieee80211_priv(dev);
10563 return (priv->status & STATUS_ASSOCIATED) != 0;
10564}
10565
10566static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10567{
James Ketrenosb095c382005-08-24 22:04:42 -050010568 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010569}
10570
10571static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010572 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010573{
10574 struct ipw_priv *p = ieee80211_priv(dev);
10575
James Ketrenosb095c382005-08-24 22:04:42 -050010576 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010577 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010578 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010579 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010580 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010581 return 0;
10582}
10583
10584static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010585 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010586{
10587 struct ipw_priv *p = ieee80211_priv(dev);
10588 int i;
10589
James Ketrenosb095c382005-08-24 22:04:42 -050010590 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010591 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010592 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010593 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010594 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10595 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010596 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010597 return 0;
10598}
10599
Jeff Garzik7282d492006-09-13 14:30:00 -040010600static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010601 .get_link = ipw_ethtool_get_link,
10602 .get_drvinfo = ipw_ethtool_get_drvinfo,
10603 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10604 .get_eeprom = ipw_ethtool_get_eeprom,
10605 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010606};
10607
David Howells7d12e782006-10-05 14:55:46 +010010608static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010609{
10610 struct ipw_priv *priv = data;
10611 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010612
James Ketrenos43f66a62005-03-25 12:31:53 -060010613 if (!priv)
10614 return IRQ_NONE;
10615
Zhu Yi89c318e2006-06-08 22:19:49 -070010616 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010617
10618 if (!(priv->status & STATUS_INT_ENABLED)) {
Zhu Yid00d0122007-07-12 16:09:40 +080010619 /* IRQ is disabled */
James Ketrenos43f66a62005-03-25 12:31:53 -060010620 goto none;
10621 }
10622
James Ketrenosb095c382005-08-24 22:04:42 -050010623 inta = ipw_read32(priv, IPW_INTA_RW);
10624 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010625
James Ketrenos43f66a62005-03-25 12:31:53 -060010626 if (inta == 0xFFFFFFFF) {
10627 /* Hardware disappeared */
10628 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10629 goto none;
10630 }
10631
James Ketrenosb095c382005-08-24 22:04:42 -050010632 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010633 /* Shared interrupt */
10634 goto none;
10635 }
10636
10637 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010638 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010639
James Ketrenos43f66a62005-03-25 12:31:53 -060010640 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010641 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10642 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010643
James Ketrenos43f66a62005-03-25 12:31:53 -060010644 /* Cache INTA value for our tasklet */
10645 priv->isr_inta = inta;
10646
10647 tasklet_schedule(&priv->irq_tasklet);
10648
Zhu Yi89c318e2006-06-08 22:19:49 -070010649 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010650
10651 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010652 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010653 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010654 return IRQ_NONE;
10655}
10656
10657static void ipw_rf_kill(void *adapter)
10658{
10659 struct ipw_priv *priv = adapter;
10660 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010661
James Ketrenos43f66a62005-03-25 12:31:53 -060010662 spin_lock_irqsave(&priv->lock, flags);
10663
10664 if (rf_kill_active(priv)) {
10665 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10666 if (priv->workqueue)
10667 queue_delayed_work(priv->workqueue,
10668 &priv->rf_kill, 2 * HZ);
10669 goto exit_unlock;
10670 }
10671
10672 /* RF Kill is now disabled, so bring the device back up */
10673
10674 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10675 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10676 "device\n");
10677
10678 /* we can not do an adapter restart while inside an irq lock */
10679 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010680 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010681 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10682 "enabled\n");
10683
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010684 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010685 spin_unlock_irqrestore(&priv->lock, flags);
10686}
10687
David Howellsc4028952006-11-22 14:57:56 +000010688static void ipw_bg_rf_kill(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010689{
David Howellsc4028952006-11-22 14:57:56 +000010690 struct ipw_priv *priv =
10691 container_of(work, struct ipw_priv, rf_kill.work);
Zhu Yi46441512006-01-24 16:37:59 +080010692 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010693 ipw_rf_kill(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010694 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010695}
10696
Adrian Bunka73e22b2006-01-21 01:39:42 +010010697static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010698{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010699 priv->last_seq_num = -1;
10700 priv->last_frag_num = -1;
10701 priv->last_packet_time = 0;
10702
James Ketrenosa613bff2005-08-24 21:43:11 -050010703 netif_carrier_on(priv->net_dev);
10704 if (netif_queue_stopped(priv->net_dev)) {
10705 IPW_DEBUG_NOTIF("waking queue\n");
10706 netif_wake_queue(priv->net_dev);
10707 } else {
10708 IPW_DEBUG_NOTIF("starting queue\n");
10709 netif_start_queue(priv->net_dev);
10710 }
10711
James Ketrenosc848d0a2005-08-24 21:56:24 -050010712 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010713 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010714 ipw_reset_stats(priv);
10715 /* Ensure the rate is updated immediately */
10716 priv->last_rate = ipw_get_current_rate(priv);
10717 ipw_gather_stats(priv);
10718 ipw_led_link_up(priv);
10719 notify_wx_assoc_event(priv);
10720
10721 if (priv->config & CFG_BACKGROUND_SCAN)
10722 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10723}
10724
David Howellsc4028952006-11-22 14:57:56 +000010725static void ipw_bg_link_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010726{
David Howellsc4028952006-11-22 14:57:56 +000010727 struct ipw_priv *priv =
10728 container_of(work, struct ipw_priv, link_up);
Zhu Yi46441512006-01-24 16:37:59 +080010729 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010730 ipw_link_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010731 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010732}
10733
Adrian Bunka73e22b2006-01-21 01:39:42 +010010734static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010735{
10736 ipw_led_link_down(priv);
10737 netif_carrier_off(priv->net_dev);
10738 netif_stop_queue(priv->net_dev);
10739 notify_wx_assoc_event(priv);
10740
10741 /* Cancel any queued work ... */
10742 cancel_delayed_work(&priv->request_scan);
10743 cancel_delayed_work(&priv->adhoc_check);
10744 cancel_delayed_work(&priv->gather_stats);
10745
10746 ipw_reset_stats(priv);
10747
James Ketrenosafbf30a2005-08-25 00:05:33 -050010748 if (!(priv->status & STATUS_EXIT_PENDING)) {
10749 /* Queue up another scan... */
David Howellsc4028952006-11-22 14:57:56 +000010750 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
Dan Williams0b531672007-10-09 13:55:24 -040010751 } else
10752 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010753}
10754
David Howellsc4028952006-11-22 14:57:56 +000010755static void ipw_bg_link_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010756{
David Howellsc4028952006-11-22 14:57:56 +000010757 struct ipw_priv *priv =
10758 container_of(work, struct ipw_priv, link_down);
Zhu Yi46441512006-01-24 16:37:59 +080010759 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010760 ipw_link_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010761 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010762}
10763
Adrian Bunk2ef19e62007-12-11 23:20:22 +010010764static int __devinit ipw_setup_deferred_work(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010765{
10766 int ret = 0;
10767
James Ketrenos43f66a62005-03-25 12:31:53 -060010768 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010769 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010770 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010771
David Howellsc4028952006-11-22 14:57:56 +000010772 INIT_DELAYED_WORK(&priv->adhoc_check, ipw_bg_adhoc_check);
10773 INIT_WORK(&priv->associate, ipw_bg_associate);
10774 INIT_WORK(&priv->disassociate, ipw_bg_disassociate);
10775 INIT_WORK(&priv->system_config, ipw_system_config);
10776 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish);
10777 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart);
10778 INIT_DELAYED_WORK(&priv->rf_kill, ipw_bg_rf_kill);
10779 INIT_WORK(&priv->up, ipw_bg_up);
10780 INIT_WORK(&priv->down, ipw_bg_down);
10781 INIT_DELAYED_WORK(&priv->request_scan, ipw_request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010782 INIT_DELAYED_WORK(&priv->scan_event, ipw_scan_event);
David Howellsc4028952006-11-22 14:57:56 +000010783 INIT_WORK(&priv->request_passive_scan, ipw_request_passive_scan);
10784 INIT_DELAYED_WORK(&priv->gather_stats, ipw_bg_gather_stats);
10785 INIT_WORK(&priv->abort_scan, ipw_bg_abort_scan);
10786 INIT_WORK(&priv->roam, ipw_bg_roam);
10787 INIT_DELAYED_WORK(&priv->scan_check, ipw_bg_scan_check);
10788 INIT_WORK(&priv->link_up, ipw_bg_link_up);
10789 INIT_WORK(&priv->link_down, ipw_bg_link_down);
10790 INIT_DELAYED_WORK(&priv->led_link_on, ipw_bg_led_link_on);
10791 INIT_DELAYED_WORK(&priv->led_link_off, ipw_bg_led_link_off);
10792 INIT_DELAYED_WORK(&priv->led_act_off, ipw_bg_led_activity_off);
10793 INIT_WORK(&priv->merge_networks, ipw_merge_adhoc_network);
James Ketrenos43f66a62005-03-25 12:31:53 -060010794
Zhu Yie43e3c12006-04-13 17:20:45 +080010795#ifdef CONFIG_IPW2200_QOS
David Howellsc4028952006-11-22 14:57:56 +000010796 INIT_WORK(&priv->qos_activate, ipw_bg_qos_activate);
Zhu Yie43e3c12006-04-13 17:20:45 +080010797#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010798
10799 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10800 ipw_irq_tasklet, (unsigned long)priv);
10801
10802 return ret;
10803}
10804
James Ketrenos43f66a62005-03-25 12:31:53 -060010805static void shim__set_security(struct net_device *dev,
10806 struct ieee80211_security *sec)
10807{
10808 struct ipw_priv *priv = ieee80211_priv(dev);
10809 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010810 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010811 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010812 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010813 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010814 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010815 priv->ieee->sec.flags &= ~(1 << i);
10816 else {
10817 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010818 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010819 priv->ieee->sec.flags |= (1 << i);
10820 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010821 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010822 } else if (sec->level != SEC_LEVEL_1)
10823 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010824 }
10825
James Ketrenosb095c382005-08-24 22:04:42 -050010826 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010827 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010828 priv->ieee->sec.active_key = sec->active_key;
10829 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010830 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010831 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010832 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010833 } else
10834 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010835
10836 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010837 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10838 priv->ieee->sec.auth_mode = sec->auth_mode;
10839 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010840 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10841 priv->capability |= CAP_SHARED_KEY;
10842 else
10843 priv->capability &= ~CAP_SHARED_KEY;
10844 priv->status |= STATUS_SECURITY_UPDATED;
10845 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010846
James Ketrenosb095c382005-08-24 22:04:42 -050010847 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10848 priv->ieee->sec.flags |= SEC_ENABLED;
10849 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010850 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010851 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010852 priv->capability |= CAP_PRIVACY_ON;
10853 else
10854 priv->capability &= ~CAP_PRIVACY_ON;
10855 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010856
James Ketrenosafbf30a2005-08-25 00:05:33 -050010857 if (sec->flags & SEC_ENCRYPT)
10858 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010859
James Ketrenosb095c382005-08-24 22:04:42 -050010860 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10861 priv->ieee->sec.level = sec->level;
10862 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010863 priv->status |= STATUS_SECURITY_UPDATED;
10864 }
10865
Zhu Yi1fbfea52005-08-05 17:22:56 +080010866 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10867 ipw_set_hwcrypto_keys(priv);
10868
Jeff Garzikbf794512005-07-31 13:07:26 -040010869 /* To match current functionality of ipw2100 (which works well w/
10870 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010871 * privacy capability changes ... */
10872#if 0
10873 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010874 (((priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010875 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010876 (!(priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010877 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010878 IPW_DEBUG_ASSOC("Disassociating due to capability "
10879 "change.\n");
10880 ipw_disassociate(priv);
10881 }
10882#endif
10883}
10884
Jeff Garzikbf794512005-07-31 13:07:26 -040010885static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010886 struct ipw_supported_rates *rates)
10887{
10888 /* TODO: Mask out rates based on priv->rates_mask */
10889
10890 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010891 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010892 switch (priv->ieee->freq_band) {
10893 case IEEE80211_52GHZ_BAND:
10894 rates->ieee_mode = IPW_A_MODE;
10895 rates->purpose = IPW_RATE_CAPABILITIES;
10896 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10897 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10898 break;
10899
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010900 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010901 rates->ieee_mode = IPW_G_MODE;
10902 rates->purpose = IPW_RATE_CAPABILITIES;
10903 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10904 IEEE80211_CCK_DEFAULT_RATES_MASK);
10905 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10906 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10907 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10908 }
10909 break;
10910 }
10911
10912 return 0;
10913}
10914
Jeff Garzikbf794512005-07-31 13:07:26 -040010915static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010916{
James Ketrenos43f66a62005-03-25 12:31:53 -060010917 /* This is only called from ipw_up, which resets/reloads the firmware
10918 so, we don't need to first disable the card before we configure
10919 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010920 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010921 goto error;
10922
10923 /* initialize adapter address */
10924 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10925 goto error;
10926
10927 /* set basic system config settings */
10928 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010929
10930 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10931 * Does not support BT priority yet (don't abort or defer our Tx) */
10932 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010933 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010934
10935 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10936 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010937 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010938 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10939 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010940 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010941 }
10942
Zhu Yid685b8c2006-04-13 17:20:27 +080010943#ifdef CONFIG_IPW2200_PROMISCUOUS
10944 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10945 priv->sys_config.accept_all_data_frames = 1;
10946 priv->sys_config.accept_non_directed_frames = 1;
10947 priv->sys_config.accept_all_mgmt_bcpr = 1;
10948 priv->sys_config.accept_all_mgmt_frames = 1;
10949 }
10950#endif
10951
James Ketrenosc848d0a2005-08-24 21:56:24 -050010952 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10953 priv->sys_config.answer_broadcast_ssid_probe = 1;
10954 else
10955 priv->sys_config.answer_broadcast_ssid_probe = 0;
10956
Zhu Yid685b8c2006-04-13 17:20:27 +080010957 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010958 goto error;
10959
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010960 init_supported_rates(priv, &priv->rates);
10961 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010962 goto error;
10963
10964 /* Set request-to-send threshold */
10965 if (priv->rts_threshold) {
10966 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10967 goto error;
10968 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010969#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010970 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10971 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010972#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010973
10974 if (ipw_set_random_seed(priv))
10975 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010976
James Ketrenos43f66a62005-03-25 12:31:53 -060010977 /* final state transition to the RUN state */
10978 if (ipw_send_host_complete(priv))
10979 goto error;
10980
James Ketrenose6666192005-08-12 09:17:04 -050010981 priv->status |= STATUS_INIT;
10982
10983 ipw_led_init(priv);
10984 ipw_led_radio_on(priv);
10985 priv->notif_missed_beacons = 0;
10986
10987 /* Set hardware WEP key if it is configured. */
10988 if ((priv->capability & CAP_PRIVACY_ON) &&
10989 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10990 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10991 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010992
10993 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010994
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010995 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010996 return -EIO;
10997}
10998
James Ketrenos4f36f802005-08-03 20:36:56 -050010999/*
11000 * NOTE:
11001 *
11002 * These tables have been tested in conjunction with the
11003 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
11004 *
11005 * Altering this values, using it on other hardware, or in geographies
11006 * not intended for resale of the above mentioned Intel adapters has
11007 * not been tested.
11008 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011009 * Remember to update the table in README.ipw2200 when changing this
11010 * table.
11011 *
James Ketrenos4f36f802005-08-03 20:36:56 -050011012 */
11013static const struct ieee80211_geo ipw_geos[] = {
11014 { /* Restricted */
11015 "---",
11016 .bg_channels = 11,
11017 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11018 {2427, 4}, {2432, 5}, {2437, 6},
11019 {2442, 7}, {2447, 8}, {2452, 9},
11020 {2457, 10}, {2462, 11}},
11021 },
11022
11023 { /* Custom US/Canada */
11024 "ZZF",
11025 .bg_channels = 11,
11026 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11027 {2427, 4}, {2432, 5}, {2437, 6},
11028 {2442, 7}, {2447, 8}, {2452, 9},
11029 {2457, 10}, {2462, 11}},
11030 .a_channels = 8,
11031 .a = {{5180, 36},
11032 {5200, 40},
11033 {5220, 44},
11034 {5240, 48},
11035 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11036 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11037 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11038 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
11039 },
11040
11041 { /* Rest of World */
11042 "ZZD",
11043 .bg_channels = 13,
11044 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11045 {2427, 4}, {2432, 5}, {2437, 6},
11046 {2442, 7}, {2447, 8}, {2452, 9},
11047 {2457, 10}, {2462, 11}, {2467, 12},
11048 {2472, 13}},
11049 },
11050
11051 { /* Custom USA & Europe & High */
11052 "ZZA",
11053 .bg_channels = 11,
11054 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11055 {2427, 4}, {2432, 5}, {2437, 6},
11056 {2442, 7}, {2447, 8}, {2452, 9},
11057 {2457, 10}, {2462, 11}},
11058 .a_channels = 13,
11059 .a = {{5180, 36},
11060 {5200, 40},
11061 {5220, 44},
11062 {5240, 48},
11063 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11064 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11065 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11066 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11067 {5745, 149},
11068 {5765, 153},
11069 {5785, 157},
11070 {5805, 161},
11071 {5825, 165}},
11072 },
11073
11074 { /* Custom NA & Europe */
11075 "ZZB",
11076 .bg_channels = 11,
11077 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11078 {2427, 4}, {2432, 5}, {2437, 6},
11079 {2442, 7}, {2447, 8}, {2452, 9},
11080 {2457, 10}, {2462, 11}},
11081 .a_channels = 13,
11082 .a = {{5180, 36},
11083 {5200, 40},
11084 {5220, 44},
11085 {5240, 48},
11086 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11087 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11088 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11089 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11090 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11091 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11092 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11093 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11094 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11095 },
11096
11097 { /* Custom Japan */
11098 "ZZC",
11099 .bg_channels = 11,
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}},
11104 .a_channels = 4,
11105 .a = {{5170, 34}, {5190, 38},
11106 {5210, 42}, {5230, 46}},
11107 },
11108
11109 { /* Custom */
11110 "ZZM",
11111 .bg_channels = 11,
11112 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11113 {2427, 4}, {2432, 5}, {2437, 6},
11114 {2442, 7}, {2447, 8}, {2452, 9},
11115 {2457, 10}, {2462, 11}},
11116 },
11117
11118 { /* Europe */
11119 "ZZE",
11120 .bg_channels = 13,
11121 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11122 {2427, 4}, {2432, 5}, {2437, 6},
11123 {2442, 7}, {2447, 8}, {2452, 9},
11124 {2457, 10}, {2462, 11}, {2467, 12},
11125 {2472, 13}},
11126 .a_channels = 19,
11127 .a = {{5180, 36},
11128 {5200, 40},
11129 {5220, 44},
11130 {5240, 48},
11131 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11132 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11133 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11134 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11135 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11136 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11137 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11138 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11139 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11140 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11141 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11142 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11143 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11144 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11145 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11146 },
11147
11148 { /* Custom Japan */
11149 "ZZJ",
11150 .bg_channels = 14,
11151 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11152 {2427, 4}, {2432, 5}, {2437, 6},
11153 {2442, 7}, {2447, 8}, {2452, 9},
11154 {2457, 10}, {2462, 11}, {2467, 12},
11155 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11156 .a_channels = 4,
11157 .a = {{5170, 34}, {5190, 38},
11158 {5210, 42}, {5230, 46}},
11159 },
11160
James Ketrenos03520572005-10-19 16:12:31 -050011161 { /* Rest of World */
11162 "ZZR",
11163 .bg_channels = 14,
11164 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11165 {2427, 4}, {2432, 5}, {2437, 6},
11166 {2442, 7}, {2447, 8}, {2452, 9},
11167 {2457, 10}, {2462, 11}, {2467, 12},
11168 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11169 IEEE80211_CH_PASSIVE_ONLY}},
11170 },
11171
James Ketrenos4f36f802005-08-03 20:36:56 -050011172 { /* High Band */
11173 "ZZH",
11174 .bg_channels = 13,
11175 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11176 {2427, 4}, {2432, 5}, {2437, 6},
11177 {2442, 7}, {2447, 8}, {2452, 9},
11178 {2457, 10}, {2462, 11},
11179 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11180 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11181 .a_channels = 4,
11182 .a = {{5745, 149}, {5765, 153},
11183 {5785, 157}, {5805, 161}},
11184 },
11185
11186 { /* Custom Europe */
11187 "ZZG",
11188 .bg_channels = 13,
11189 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11190 {2427, 4}, {2432, 5}, {2437, 6},
11191 {2442, 7}, {2447, 8}, {2452, 9},
11192 {2457, 10}, {2462, 11},
11193 {2467, 12}, {2472, 13}},
11194 .a_channels = 4,
11195 .a = {{5180, 36}, {5200, 40},
11196 {5220, 44}, {5240, 48}},
11197 },
11198
11199 { /* Europe */
11200 "ZZK",
11201 .bg_channels = 13,
11202 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11203 {2427, 4}, {2432, 5}, {2437, 6},
11204 {2442, 7}, {2447, 8}, {2452, 9},
11205 {2457, 10}, {2462, 11},
11206 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11207 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11208 .a_channels = 24,
11209 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11210 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11211 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11212 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11213 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11214 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11215 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11216 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11217 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11218 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11219 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11220 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11221 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11222 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11223 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11224 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11225 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11226 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11227 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11228 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11229 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11230 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11231 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11232 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11233 },
11234
11235 { /* Europe */
11236 "ZZL",
11237 .bg_channels = 11,
11238 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11239 {2427, 4}, {2432, 5}, {2437, 6},
11240 {2442, 7}, {2447, 8}, {2452, 9},
11241 {2457, 10}, {2462, 11}},
11242 .a_channels = 13,
11243 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11244 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11245 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11246 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11247 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11248 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11249 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11250 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11251 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11252 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11253 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11254 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11255 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11256 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011257};
11258
James Ketrenos43f66a62005-03-25 12:31:53 -060011259#define MAX_HW_RESTARTS 5
11260static int ipw_up(struct ipw_priv *priv)
11261{
James Ketrenos4f36f802005-08-03 20:36:56 -050011262 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011263
11264 if (priv->status & STATUS_EXIT_PENDING)
11265 return -EIO;
11266
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011267 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011268 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011269 GFP_KERNEL);
11270 if (priv->cmdlog == NULL) {
11271 IPW_ERROR("Error allocating %d command log entries.\n",
11272 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011273 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011274 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011275 priv->cmdlog_len = cmdlog;
11276 }
11277 }
11278
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011279 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011280 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011281 * Also start the clocks. */
11282 rc = ipw_load(priv);
11283 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011284 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011285 return rc;
11286 }
11287
11288 ipw_init_ordinals(priv);
11289 if (!(priv->config & CFG_CUSTOM_MAC))
11290 eeprom_parse_mac(priv, priv->mac_addr);
11291 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11292
James Ketrenos4f36f802005-08-03 20:36:56 -050011293 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11294 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11295 ipw_geos[j].name, 3))
11296 break;
11297 }
James Ketrenos03520572005-10-19 16:12:31 -050011298 if (j == ARRAY_SIZE(ipw_geos)) {
11299 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11300 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11301 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11302 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011303 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011304 }
Larry Finger1867b112006-02-28 09:48:28 -060011305 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011306 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011307 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011308 }
11309
James Ketrenosb095c382005-08-24 22:04:42 -050011310 if (priv->status & STATUS_RF_KILL_SW) {
11311 IPW_WARNING("Radio disabled by module parameter.\n");
11312 return 0;
11313 } else if (rf_kill_active(priv)) {
11314 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11315 "Kill switch must be turned off for "
11316 "wireless networking to work.\n");
11317 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11318 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011319 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011320 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011321
11322 rc = ipw_config(priv);
11323 if (!rc) {
11324 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011325
James Ketrenose6666192005-08-12 09:17:04 -050011326 /* If configure to try and auto-associate, kick
11327 * off a scan. */
David Howellsc4028952006-11-22 14:57:56 +000011328 queue_delayed_work(priv->workqueue,
11329 &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011330
James Ketrenos43f66a62005-03-25 12:31:53 -060011331 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011332 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011333
James Ketrenosc848d0a2005-08-24 21:56:24 -050011334 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011335 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11336 i, MAX_HW_RESTARTS);
11337
11338 /* We had an error bringing up the hardware, so take it
11339 * all the way back down so we can try again */
11340 ipw_down(priv);
11341 }
11342
Jeff Garzikbf794512005-07-31 13:07:26 -040011343 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011344 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011345 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011346
James Ketrenos43f66a62005-03-25 12:31:53 -060011347 return -EIO;
11348}
11349
David Howellsc4028952006-11-22 14:57:56 +000011350static void ipw_bg_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011351{
David Howellsc4028952006-11-22 14:57:56 +000011352 struct ipw_priv *priv =
11353 container_of(work, struct ipw_priv, up);
Zhu Yi46441512006-01-24 16:37:59 +080011354 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011355 ipw_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011356 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011357}
11358
James Ketrenosb095c382005-08-24 22:04:42 -050011359static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011360{
James Ketrenosb095c382005-08-24 22:04:42 -050011361 int i;
11362
11363 if (priv->status & STATUS_SCANNING) {
11364 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11365 ipw_abort_scan(priv);
11366 }
11367
11368 if (priv->status & STATUS_ASSOCIATED) {
11369 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11370 ipw_disassociate(priv);
11371 }
11372
11373 ipw_led_shutdown(priv);
11374
11375 /* Wait up to 1s for status to change to not scanning and not
11376 * associated (disassociation can take a while for a ful 802.11
11377 * exchange */
11378 for (i = 1000; i && (priv->status &
11379 (STATUS_DISASSOCIATING |
11380 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11381 udelay(10);
11382
11383 if (priv->status & (STATUS_DISASSOCIATING |
11384 STATUS_ASSOCIATED | STATUS_SCANNING))
11385 IPW_DEBUG_INFO("Still associated or scanning...\n");
11386 else
11387 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11388
James Ketrenosc848d0a2005-08-24 21:56:24 -050011389 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011390 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011391
11392 priv->status &= ~STATUS_INIT;
11393}
11394
James Ketrenos43f66a62005-03-25 12:31:53 -060011395static void ipw_down(struct ipw_priv *priv)
11396{
James Ketrenosb095c382005-08-24 22:04:42 -050011397 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11398
11399 priv->status |= STATUS_EXIT_PENDING;
11400
11401 if (ipw_is_init(priv))
11402 ipw_deinit(priv);
11403
11404 /* Wipe out the EXIT_PENDING status bit if we are not actually
11405 * exiting the module */
11406 if (!exit_pending)
11407 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011408
11409 /* tell the device to stop sending interrupts */
11410 ipw_disable_interrupts(priv);
11411
11412 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011413 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011414 netif_carrier_off(priv->net_dev);
11415 netif_stop_queue(priv->net_dev);
11416
11417 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011418
11419 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011420}
11421
David Howellsc4028952006-11-22 14:57:56 +000011422static void ipw_bg_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011423{
David Howellsc4028952006-11-22 14:57:56 +000011424 struct ipw_priv *priv =
11425 container_of(work, struct ipw_priv, down);
Zhu Yi46441512006-01-24 16:37:59 +080011426 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011427 ipw_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011428 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011429}
11430
11431/* Called by register_netdev() */
11432static int ipw_net_init(struct net_device *dev)
11433{
11434 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011435 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011436
James Ketrenosc848d0a2005-08-24 21:56:24 -050011437 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011438 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011439 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011440 }
11441
Zhu Yi46441512006-01-24 16:37:59 +080011442 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011443 return 0;
11444}
11445
11446/* PCI driver stuff */
11447static struct pci_device_id card_ids[] = {
11448 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11449 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11450 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11451 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11452 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11453 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11454 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11455 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11456 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11457 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11458 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11459 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11460 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11461 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11462 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11463 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11464 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11465 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011466 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011467 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011468 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11469 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011470
James Ketrenos43f66a62005-03-25 12:31:53 -060011471 /* required last entry */
11472 {0,}
11473};
11474
11475MODULE_DEVICE_TABLE(pci, card_ids);
11476
11477static struct attribute *ipw_sysfs_entries[] = {
11478 &dev_attr_rf_kill.attr,
11479 &dev_attr_direct_dword.attr,
11480 &dev_attr_indirect_byte.attr,
11481 &dev_attr_indirect_dword.attr,
11482 &dev_attr_mem_gpio_reg.attr,
11483 &dev_attr_command_event_reg.attr,
11484 &dev_attr_nic_type.attr,
11485 &dev_attr_status.attr,
11486 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011487 &dev_attr_error.attr,
11488 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011489 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011490 &dev_attr_eeprom_delay.attr,
11491 &dev_attr_ucode_version.attr,
11492 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011493 &dev_attr_scan_age.attr,
11494 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011495 &dev_attr_speed_scan.attr,
11496 &dev_attr_net_stats.attr,
Zhu Yi375dd242007-02-14 16:04:24 +080011497 &dev_attr_channels.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011498#ifdef CONFIG_IPW2200_PROMISCUOUS
11499 &dev_attr_rtap_iface.attr,
11500 &dev_attr_rtap_filter.attr,
11501#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011502 NULL
11503};
11504
11505static struct attribute_group ipw_attribute_group = {
11506 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011507 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011508};
11509
Zhu Yid685b8c2006-04-13 17:20:27 +080011510#ifdef CONFIG_IPW2200_PROMISCUOUS
11511static int ipw_prom_open(struct net_device *dev)
11512{
11513 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11514 struct ipw_priv *priv = prom_priv->priv;
11515
11516 IPW_DEBUG_INFO("prom dev->open\n");
11517 netif_carrier_off(dev);
11518 netif_stop_queue(dev);
11519
11520 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11521 priv->sys_config.accept_all_data_frames = 1;
11522 priv->sys_config.accept_non_directed_frames = 1;
11523 priv->sys_config.accept_all_mgmt_bcpr = 1;
11524 priv->sys_config.accept_all_mgmt_frames = 1;
11525
11526 ipw_send_system_config(priv);
11527 }
11528
11529 return 0;
11530}
11531
11532static int ipw_prom_stop(struct net_device *dev)
11533{
11534 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11535 struct ipw_priv *priv = prom_priv->priv;
11536
11537 IPW_DEBUG_INFO("prom dev->stop\n");
11538
11539 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11540 priv->sys_config.accept_all_data_frames = 0;
11541 priv->sys_config.accept_non_directed_frames = 0;
11542 priv->sys_config.accept_all_mgmt_bcpr = 0;
11543 priv->sys_config.accept_all_mgmt_frames = 0;
11544
11545 ipw_send_system_config(priv);
11546 }
11547
11548 return 0;
11549}
11550
11551static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11552{
11553 IPW_DEBUG_INFO("prom dev->xmit\n");
11554 netif_stop_queue(dev);
11555 return -EOPNOTSUPP;
11556}
11557
11558static struct net_device_stats *ipw_prom_get_stats(struct net_device *dev)
11559{
11560 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11561 return &prom_priv->ieee->stats;
11562}
11563
11564static int ipw_prom_alloc(struct ipw_priv *priv)
11565{
11566 int rc = 0;
11567
11568 if (priv->prom_net_dev)
11569 return -EPERM;
11570
11571 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11572 if (priv->prom_net_dev == NULL)
11573 return -ENOMEM;
11574
11575 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11576 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11577 priv->prom_priv->priv = priv;
11578
11579 strcpy(priv->prom_net_dev->name, "rtap%d");
11580
11581 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
11582 priv->prom_net_dev->open = ipw_prom_open;
11583 priv->prom_net_dev->stop = ipw_prom_stop;
11584 priv->prom_net_dev->get_stats = ipw_prom_get_stats;
11585 priv->prom_net_dev->hard_start_xmit = ipw_prom_hard_start_xmit;
11586
11587 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
11588
11589 rc = register_netdev(priv->prom_net_dev);
11590 if (rc) {
11591 free_ieee80211(priv->prom_net_dev);
11592 priv->prom_net_dev = NULL;
11593 return rc;
11594 }
11595
11596 return 0;
11597}
11598
11599static void ipw_prom_free(struct ipw_priv *priv)
11600{
11601 if (!priv->prom_net_dev)
11602 return;
11603
11604 unregister_netdev(priv->prom_net_dev);
11605 free_ieee80211(priv->prom_net_dev);
11606
11607 priv->prom_net_dev = NULL;
11608}
11609
11610#endif
11611
11612
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011613static int __devinit ipw_pci_probe(struct pci_dev *pdev,
11614 const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011615{
11616 int err = 0;
11617 struct net_device *net_dev;
11618 void __iomem *base;
11619 u32 length, val;
11620 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011621 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011622
11623 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11624 if (net_dev == NULL) {
11625 err = -ENOMEM;
11626 goto out;
11627 }
11628
11629 priv = ieee80211_priv(net_dev);
11630 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011631
James Ketrenos43f66a62005-03-25 12:31:53 -060011632 priv->net_dev = net_dev;
11633 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011634 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011635 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011636 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011637 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11638 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011639
Zhu Yi46441512006-01-24 16:37:59 +080011640 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011641 if (pci_enable_device(pdev)) {
11642 err = -ENODEV;
11643 goto out_free_ieee80211;
11644 }
11645
11646 pci_set_master(pdev);
11647
Tobias Klauser0e08b442005-06-20 14:28:41 -070011648 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011649 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011650 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011651 if (err) {
11652 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11653 goto out_pci_disable_device;
11654 }
11655
11656 pci_set_drvdata(pdev, priv);
11657
11658 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011659 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011660 goto out_pci_disable_device;
11661
Jeff Garzikbf794512005-07-31 13:07:26 -040011662 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011663 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011664 pci_read_config_dword(pdev, 0x40, &val);
11665 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011666 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011667
James Ketrenos43f66a62005-03-25 12:31:53 -060011668 length = pci_resource_len(pdev, 0);
11669 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011670
James Ketrenos43f66a62005-03-25 12:31:53 -060011671 base = ioremap_nocache(pci_resource_start(pdev, 0), length);
11672 if (!base) {
11673 err = -ENODEV;
11674 goto out_pci_release_regions;
11675 }
11676
11677 priv->hw_base = base;
11678 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11679 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11680
11681 err = ipw_setup_deferred_work(priv);
11682 if (err) {
11683 IPW_ERROR("Unable to setup deferred work\n");
11684 goto out_iounmap;
11685 }
11686
James Ketrenosb095c382005-08-24 22:04:42 -050011687 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011688
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011689 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011690 if (err) {
11691 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11692 goto out_destroy_workqueue;
11693 }
11694
James Ketrenos43f66a62005-03-25 12:31:53 -060011695 SET_NETDEV_DEV(net_dev, &pdev->dev);
11696
Zhu Yi46441512006-01-24 16:37:59 +080011697 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011698
James Ketrenos43f66a62005-03-25 12:31:53 -060011699 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11700 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011701 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011702
Zhu Yie43e3c12006-04-13 17:20:45 +080011703#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011704 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011705 priv->ieee->handle_probe_response = ipw_handle_beacon;
11706 priv->ieee->handle_beacon = ipw_handle_probe_response;
11707 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011708#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011709
James Ketrenosc848d0a2005-08-24 21:56:24 -050011710 priv->ieee->perfect_rssi = -20;
11711 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011712
11713 net_dev->open = ipw_net_open;
11714 net_dev->stop = ipw_net_stop;
11715 net_dev->init = ipw_net_init;
11716 net_dev->get_stats = ipw_net_get_stats;
11717 net_dev->set_multicast_list = ipw_net_set_multicast_list;
11718 net_dev->set_mac_address = ipw_net_set_mac_address;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011719 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011720 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011721 net_dev->wireless_handlers = &ipw_wx_handler_def;
11722 net_dev->ethtool_ops = &ipw_ethtool_ops;
11723 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011724 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011725 net_dev->mem_start = pci_resource_start(pdev, 0);
11726 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11727
11728 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11729 if (err) {
11730 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011731 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011732 goto out_release_irq;
11733 }
11734
Zhu Yi46441512006-01-24 16:37:59 +080011735 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011736 err = register_netdev(net_dev);
11737 if (err) {
11738 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011739 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011740 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011741
Zhu Yid685b8c2006-04-13 17:20:27 +080011742#ifdef CONFIG_IPW2200_PROMISCUOUS
11743 if (rtap_iface) {
11744 err = ipw_prom_alloc(priv);
11745 if (err) {
11746 IPW_ERROR("Failed to register promiscuous network "
11747 "device (error %d).\n", err);
11748 unregister_netdev(priv->net_dev);
11749 goto out_remove_sysfs;
11750 }
11751 }
11752#endif
11753
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011754 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11755 "channels, %d 802.11a channels)\n",
11756 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11757 priv->ieee->geo.a_channels);
11758
James Ketrenos43f66a62005-03-25 12:31:53 -060011759 return 0;
11760
James Ketrenosa613bff2005-08-24 21:43:11 -050011761 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011762 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011763 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011764 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011765 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011766 destroy_workqueue(priv->workqueue);
11767 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011768 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011769 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011770 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011771 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011772 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011773 pci_disable_device(pdev);
11774 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011775 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011776 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011777 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011778 return err;
11779}
11780
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011781static void __devexit ipw_pci_remove(struct pci_dev *pdev)
James Ketrenos43f66a62005-03-25 12:31:53 -060011782{
11783 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011784 struct list_head *p, *q;
11785 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011786
James Ketrenos43f66a62005-03-25 12:31:53 -060011787 if (!priv)
11788 return;
11789
Zhu Yi46441512006-01-24 16:37:59 +080011790 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011791
James Ketrenosafbf30a2005-08-25 00:05:33 -050011792 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011793 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011794 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11795
Zhu Yi46441512006-01-24 16:37:59 +080011796 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011797
11798 unregister_netdev(priv->net_dev);
11799
11800 if (priv->rxq) {
11801 ipw_rx_queue_free(priv, priv->rxq);
11802 priv->rxq = NULL;
11803 }
11804 ipw_tx_queue_free(priv);
11805
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011806 if (priv->cmdlog) {
11807 kfree(priv->cmdlog);
11808 priv->cmdlog = NULL;
11809 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011810 /* ipw_down will ensure that there is no more pending work
11811 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011812 cancel_delayed_work(&priv->adhoc_check);
11813 cancel_delayed_work(&priv->gather_stats);
11814 cancel_delayed_work(&priv->request_scan);
Dan Williams0b531672007-10-09 13:55:24 -040011815 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050011816 cancel_delayed_work(&priv->rf_kill);
11817 cancel_delayed_work(&priv->scan_check);
11818 destroy_workqueue(priv->workqueue);
11819 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011820
James Ketrenosafbf30a2005-08-25 00:05:33 -050011821 /* Free MAC hash list for ADHOC */
11822 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11823 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011824 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011825 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011826 }
11827 }
11828
Jesper Juhl8f760782006-06-27 02:55:06 -070011829 kfree(priv->error);
11830 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011831
Zhu Yid685b8c2006-04-13 17:20:27 +080011832#ifdef CONFIG_IPW2200_PROMISCUOUS
11833 ipw_prom_free(priv);
11834#endif
11835
James Ketrenos43f66a62005-03-25 12:31:53 -060011836 free_irq(pdev->irq, priv);
11837 iounmap(priv->hw_base);
11838 pci_release_regions(pdev);
11839 pci_disable_device(pdev);
11840 pci_set_drvdata(pdev, NULL);
11841 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011842 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011843}
11844
James Ketrenos43f66a62005-03-25 12:31:53 -060011845#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011846static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011847{
11848 struct ipw_priv *priv = pci_get_drvdata(pdev);
11849 struct net_device *dev = priv->net_dev;
11850
11851 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11852
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011853 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011854 ipw_down(priv);
11855
11856 /* Remove the PRESENT state of the device */
11857 netif_device_detach(dev);
11858
James Ketrenos43f66a62005-03-25 12:31:53 -060011859 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011860 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011861 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011862
James Ketrenos43f66a62005-03-25 12:31:53 -060011863 return 0;
11864}
11865
11866static int ipw_pci_resume(struct pci_dev *pdev)
11867{
11868 struct ipw_priv *priv = pci_get_drvdata(pdev);
11869 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011870 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011871 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011872
James Ketrenos43f66a62005-03-25 12:31:53 -060011873 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11874
James Ketrenosea2b26e2005-08-24 21:25:16 -050011875 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011876 err = pci_enable_device(pdev);
11877 if (err) {
11878 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11879 dev->name);
11880 return err;
11881 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011882 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011883
James Ketrenos43f66a62005-03-25 12:31:53 -060011884 /*
11885 * Suspend/Resume resets the PCI configuration space, so we have to
11886 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11887 * from interfering with C3 CPU state. pci_restore_state won't help
11888 * here since it only restores the first 64 bytes pci config header.
11889 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011890 pci_read_config_dword(pdev, 0x40, &val);
11891 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011892 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11893
11894 /* Set the device back into the PRESENT state; this will also wake
11895 * the queue of needed */
11896 netif_device_attach(dev);
11897
11898 /* Bring the device back up */
11899 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011900
James Ketrenos43f66a62005-03-25 12:31:53 -060011901 return 0;
11902}
11903#endif
11904
Zhu Yic8c22c92006-08-21 11:38:39 +080011905static void ipw_pci_shutdown(struct pci_dev *pdev)
11906{
11907 struct ipw_priv *priv = pci_get_drvdata(pdev);
11908
11909 /* Take down the device; powers it off, etc. */
11910 ipw_down(priv);
11911
11912 pci_disable_device(pdev);
11913}
11914
James Ketrenos43f66a62005-03-25 12:31:53 -060011915/* driver initialization stuff */
11916static struct pci_driver ipw_driver = {
11917 .name = DRV_NAME,
11918 .id_table = card_ids,
11919 .probe = ipw_pci_probe,
11920 .remove = __devexit_p(ipw_pci_remove),
11921#ifdef CONFIG_PM
11922 .suspend = ipw_pci_suspend,
11923 .resume = ipw_pci_resume,
11924#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011925 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011926};
11927
11928static int __init ipw_init(void)
11929{
11930 int ret;
11931
11932 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11933 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11934
Jeff Garzik29917622006-08-19 17:48:59 -040011935 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011936 if (ret) {
11937 IPW_ERROR("Unable to initialize PCI module\n");
11938 return ret;
11939 }
11940
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011941 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011942 if (ret) {
11943 IPW_ERROR("Unable to create driver sysfs file\n");
11944 pci_unregister_driver(&ipw_driver);
11945 return ret;
11946 }
11947
11948 return ret;
11949}
11950
11951static void __exit ipw_exit(void)
11952{
11953 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11954 pci_unregister_driver(&ipw_driver);
11955}
11956
11957module_param(disable, int, 0444);
11958MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11959
11960module_param(associate, int, 0444);
11961MODULE_PARM_DESC(associate, "auto associate when scanning (default on)");
11962
11963module_param(auto_create, int, 0444);
11964MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11965
James Ketrenosa613bff2005-08-24 21:43:11 -050011966module_param(led, int, 0444);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011967MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011968
James Ketrenos43f66a62005-03-25 12:31:53 -060011969module_param(debug, int, 0444);
11970MODULE_PARM_DESC(debug, "debug output mask");
11971
11972module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011973MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011974
Zhu Yid685b8c2006-04-13 17:20:27 +080011975#ifdef CONFIG_IPW2200_PROMISCUOUS
11976module_param(rtap_iface, int, 0444);
11977MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11978#endif
11979
Zhu Yie43e3c12006-04-13 17:20:45 +080011980#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011981module_param(qos_enable, int, 0444);
11982MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011983
James Ketrenosb095c382005-08-24 22:04:42 -050011984module_param(qos_burst_enable, int, 0444);
11985MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11986
11987module_param(qos_no_ack_mask, int, 0444);
11988MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11989
11990module_param(burst_duration_CCK, int, 0444);
11991MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11992
11993module_param(burst_duration_OFDM, int, 0444);
11994MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011995#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011996
11997#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060011998module_param(mode, int, 0444);
11999MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
12000#else
12001module_param(mode, int, 0444);
12002MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
12003#endif
12004
Zhu Yi810dabd2006-01-24 16:36:59 +080012005module_param(bt_coexist, int, 0444);
12006MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
12007
James Ketrenosb095c382005-08-24 22:04:42 -050012008module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080012009MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050012010
James Ketrenosf6c5cb72005-08-25 00:39:09 -050012011module_param(cmdlog, int, 0444);
12012MODULE_PARM_DESC(cmdlog,
12013 "allocate a ring buffer for logging firmware commands");
12014
Zhu Yi4bfdb912006-01-24 16:37:16 +080012015module_param(roaming, int, 0444);
12016MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
12017
Zhu Yid2b83e12006-04-13 17:19:36 +080012018module_param(antenna, int, 0444);
12019MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
12020
James Ketrenos43f66a62005-03-25 12:31:53 -060012021module_exit(ipw_exit);
12022module_init(ipw_init);