blob: e17a4593e1f5f1d3c82fa5830b51d7c9bf78628a [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"
34
Zhu Yiae4af612006-04-13 17:20:34 +080035
36#ifndef KBUILD_EXTMOD
37#define VK "k"
38#else
39#define VK
40#endif
41
42#ifdef CONFIG_IPW2200_DEBUG
43#define VD "d"
44#else
45#define VD
46#endif
47
48#ifdef CONFIG_IPW2200_MONITOR
49#define VM "m"
50#else
51#define VM
52#endif
53
54#ifdef CONFIG_IPW2200_PROMISCUOUS
55#define VP "p"
56#else
57#define VP
58#endif
59
Zhu Yi459d4082006-04-13 17:21:00 +080060#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yiae4af612006-04-13 17:20:34 +080061#define VR "r"
62#else
63#define VR
64#endif
65
66#ifdef CONFIG_IPW2200_QOS
67#define VQ "q"
68#else
69#define VQ
70#endif
71
Zhu Yiee2c4ad2007-07-12 16:09:47 +080072#define IPW2200_VERSION "1.2.2" VK VD VM VP VR VQ
James Ketrenos43f66a62005-03-25 12:31:53 -060073#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2200/2915 Network Driver"
Zhu Yi171e7b22006-02-15 07:17:56 +080074#define DRV_COPYRIGHT "Copyright(c) 2003-2006 Intel Corporation"
James Ketrenos43f66a62005-03-25 12:31:53 -060075#define DRV_VERSION IPW2200_VERSION
76
James Ketrenosb095c382005-08-24 22:04:42 -050077#define ETH_P_80211_STATS (ETH_P_80211_RAW + 1)
78
James Ketrenos43f66a62005-03-25 12:31:53 -060079MODULE_DESCRIPTION(DRV_DESCRIPTION);
80MODULE_VERSION(DRV_VERSION);
81MODULE_AUTHOR(DRV_COPYRIGHT);
82MODULE_LICENSE("GPL");
83
James Ketrenosf6c5cb72005-08-25 00:39:09 -050084static int cmdlog = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060085static int debug = 0;
86static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060087static int mode = 0;
88
89static u32 ipw_debug_level;
Tim Gardner5c7f9b72008-10-14 10:38:03 -060090static int associate;
James Ketrenos43f66a62005-03-25 12:31:53 -060091static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050092static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060093static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080094static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080095static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080096static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -060097static const char ipw_modes[] = {
98 'a', 'b', 'g', '?'
99};
Zhu Yid2b83e12006-04-13 17:19:36 +0800100static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600101
Zhu Yid685b8c2006-04-13 17:20:27 +0800102#ifdef CONFIG_IPW2200_PROMISCUOUS
103static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
104#endif
105
106
Zhu Yie43e3c12006-04-13 17:20:45 +0800107#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500108static int qos_enable = 0;
109static int qos_burst_enable = 0;
110static int qos_no_ack_mask = 0;
111static int burst_duration_CCK = 0;
112static int burst_duration_OFDM = 0;
113
114static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
115 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
116 QOS_TX3_CW_MIN_OFDM},
117 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
118 QOS_TX3_CW_MAX_OFDM},
119 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
120 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
121 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
122 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
123};
124
125static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
126 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
127 QOS_TX3_CW_MIN_CCK},
128 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
129 QOS_TX3_CW_MAX_CCK},
130 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
131 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
132 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
133 QOS_TX3_TXOP_LIMIT_CCK}
134};
135
136static struct ieee80211_qos_parameters def_parameters_OFDM = {
137 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
138 DEF_TX3_CW_MIN_OFDM},
139 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
140 DEF_TX3_CW_MAX_OFDM},
141 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
142 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
143 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
144 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
145};
146
147static struct ieee80211_qos_parameters def_parameters_CCK = {
148 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
149 DEF_TX3_CW_MIN_CCK},
150 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
151 DEF_TX3_CW_MAX_CCK},
152 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
153 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
154 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
155 DEF_TX3_TXOP_LIMIT_CCK}
156};
157
158static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
159
160static int from_priority_to_tx_queue[] = {
161 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
162 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
163};
164
165static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
166
167static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
168 *qos_param);
169static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
170 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800171#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500172
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000173static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500174static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600175static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400176static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600177 struct clx2_tx_queue *txq, int qindex);
178static int ipw_queue_reset(struct ipw_priv *priv);
179
180static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
181 int len, int sync);
182
183static void ipw_tx_queue_free(struct ipw_priv *);
184
185static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
186static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
187static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600188static int ipw_up(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000189static void ipw_bg_up(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600190static void ipw_down(struct ipw_priv *);
David Howellsc4028952006-11-22 14:57:56 +0000191static void ipw_bg_down(struct work_struct *work);
James Ketrenos43f66a62005-03-25 12:31:53 -0600192static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400193static int init_supported_rates(struct ipw_priv *priv,
194 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500195static void ipw_set_hwcrypto_keys(struct ipw_priv *);
196static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600197
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500198static int snprint_line(char *buf, size_t count,
199 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600200{
201 int out, i, j, l;
202 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400203
James Ketrenos43f66a62005-03-25 12:31:53 -0600204 out = snprintf(buf, count, "%08X", ofs);
205
206 for (l = 0, i = 0; i < 2; i++) {
207 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400208 for (j = 0; j < 8 && l < len; j++, l++)
209 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600210 data[(i * 8 + j)]);
211 for (; j < 8; j++)
212 out += snprintf(buf + out, count - out, " ");
213 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400214
James Ketrenos43f66a62005-03-25 12:31:53 -0600215 out += snprintf(buf + out, count - out, " ");
216 for (l = 0, i = 0; i < 2; i++) {
217 out += snprintf(buf + out, count - out, " ");
218 for (j = 0; j < 8 && l < len; j++, l++) {
219 c = data[(i * 8 + j)];
220 if (!isascii(c) || !isprint(c))
221 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400222
James Ketrenos43f66a62005-03-25 12:31:53 -0600223 out += snprintf(buf + out, count - out, "%c", c);
224 }
225
226 for (; j < 8; j++)
227 out += snprintf(buf + out, count - out, " ");
228 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400229
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500230 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600231}
232
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400233static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600234{
235 char line[81];
236 u32 ofs = 0;
237 if (!(ipw_debug_level & level))
238 return;
239
240 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500241 snprint_line(line, sizeof(line), &data[ofs],
242 min(len, 16U), ofs);
243 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600244 ofs += 16;
245 len -= min(len, 16U);
246 }
247}
248
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500249static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
250{
251 size_t out = size;
252 u32 ofs = 0;
253 int total = 0;
254
255 while (size && len) {
256 out = snprint_line(output, size, &data[ofs],
257 min_t(size_t, len, 16U), ofs);
258
259 ofs += 16;
260 output += out;
261 size -= out;
262 len -= min_t(size_t, len, 16U);
263 total += out;
264 }
265 return total;
266}
267
Zhu Yic8fe6672006-01-24 16:36:36 +0800268/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600269static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
270#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
271
Zhu Yic8fe6672006-01-24 16:36:36 +0800272/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600273static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
274#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
275
Zhu Yic8fe6672006-01-24 16:36:36 +0800276/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600277static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
278static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
279{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400280 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
281 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600282 _ipw_write_reg8(a, b, c);
283}
284
Zhu Yic8fe6672006-01-24 16:36:36 +0800285/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600286static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
287static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
288{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400289 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
290 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600291 _ipw_write_reg16(a, b, c);
292}
293
Zhu Yic8fe6672006-01-24 16:36:36 +0800294/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600295static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
296static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
297{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400298 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
299 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600300 _ipw_write_reg32(a, b, c);
301}
302
Zhu Yic8fe6672006-01-24 16:36:36 +0800303/* 8-bit direct write (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100304static inline void _ipw_write8(struct ipw_priv *ipw, unsigned long ofs,
305 u8 val)
306{
307 writeb(val, ipw->hw_base + ofs);
308}
Zhu Yic8fe6672006-01-24 16:36:36 +0800309
310/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
Takashi Iwaifb55d882008-07-31 19:02:06 +0200311#define ipw_write8(ipw, ofs, val) do { \
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100312 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, \
313 __LINE__, (u32)(ofs), (u32)(val)); \
314 _ipw_write8(ipw, ofs, val); \
315} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -0600316
Zhu Yic8fe6672006-01-24 16:36:36 +0800317/* 16-bit direct write (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100318static inline void _ipw_write16(struct ipw_priv *ipw, unsigned long ofs,
319 u16 val)
320{
321 writew(val, ipw->hw_base + ofs);
322}
Zhu Yic8fe6672006-01-24 16:36:36 +0800323
324/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100325#define ipw_write16(ipw, ofs, val) do { \
326 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, \
327 __LINE__, (u32)(ofs), (u32)(val)); \
328 _ipw_write16(ipw, ofs, val); \
329} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -0600330
Zhu Yic8fe6672006-01-24 16:36:36 +0800331/* 32-bit direct write (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100332static inline void _ipw_write32(struct ipw_priv *ipw, unsigned long ofs,
333 u32 val)
334{
335 writel(val, ipw->hw_base + ofs);
336}
Zhu Yic8fe6672006-01-24 16:36:36 +0800337
338/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100339#define ipw_write32(ipw, ofs, val) do { \
340 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, \
341 __LINE__, (u32)(ofs), (u32)(val)); \
342 _ipw_write32(ipw, ofs, val); \
343} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -0600344
Zhu Yic8fe6672006-01-24 16:36:36 +0800345/* 8-bit direct read (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100346static inline u8 _ipw_read8(struct ipw_priv *ipw, unsigned long ofs)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400347{
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100348 return readb(ipw->hw_base + ofs);
James Ketrenos43f66a62005-03-25 12:31:53 -0600349}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400350
Zhu Yic8fe6672006-01-24 16:36:36 +0800351/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100352#define ipw_read8(ipw, ofs) ({ \
353 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", __FILE__, __LINE__, \
354 (u32)(ofs)); \
355 _ipw_read8(ipw, ofs); \
356})
James Ketrenos43f66a62005-03-25 12:31:53 -0600357
Zhu Yic8fe6672006-01-24 16:36:36 +0800358/* 16-bit direct read (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100359static inline u16 _ipw_read16(struct ipw_priv *ipw, unsigned long ofs)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400360{
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100361 return readw(ipw->hw_base + ofs);
James Ketrenos43f66a62005-03-25 12:31:53 -0600362}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400363
Zhu Yic8fe6672006-01-24 16:36:36 +0800364/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100365#define ipw_read16(ipw, ofs) ({ \
366 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", __FILE__, __LINE__, \
367 (u32)(ofs)); \
368 _ipw_read16(ipw, ofs); \
369})
James Ketrenos43f66a62005-03-25 12:31:53 -0600370
Zhu Yic8fe6672006-01-24 16:36:36 +0800371/* 32-bit direct read (low 4K) */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100372static inline u32 _ipw_read32(struct ipw_priv *ipw, unsigned long ofs)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400373{
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100374 return readl(ipw->hw_base + ofs);
James Ketrenos43f66a62005-03-25 12:31:53 -0600375}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400376
Zhu Yic8fe6672006-01-24 16:36:36 +0800377/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100378#define ipw_read32(ipw, ofs) ({ \
379 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", __FILE__, __LINE__, \
380 (u32)(ofs)); \
381 _ipw_read32(ipw, ofs); \
382})
James Ketrenos43f66a62005-03-25 12:31:53 -0600383
384static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
Zhu Yic8fe6672006-01-24 16:36:36 +0800385/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100386#define ipw_read_indirect(a, b, c, d) ({ \
387 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %u bytes\n", __FILE__, \
388 __LINE__, (u32)(b), (u32)(d)); \
389 _ipw_read_indirect(a, b, c, d); \
390})
James Ketrenos43f66a62005-03-25 12:31:53 -0600391
Zhu Yic8fe6672006-01-24 16:36:36 +0800392/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400393static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
394 int num);
Jiri Slaby1788bcd2009-02-12 22:29:40 +0100395#define ipw_write_indirect(a, b, c, d) do { \
396 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %u bytes\n", __FILE__, \
397 __LINE__, (u32)(b), (u32)(d)); \
398 _ipw_write_indirect(a, b, c, d); \
399} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -0600400
Zhu Yic8fe6672006-01-24 16:36:36 +0800401/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400402static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600403{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400404 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500405 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
406 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600407}
408
Zhu Yic8fe6672006-01-24 16:36:36 +0800409/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600410static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
411{
Zhu Yi2638bc32006-01-24 16:37:52 +0800412 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800413 u32 dif_len = reg - aligned_addr;
414
James Ketrenos43f66a62005-03-25 12:31:53 -0600415 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800416 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
417 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600418}
419
Zhu Yic8fe6672006-01-24 16:36:36 +0800420/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400421static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600422{
Zhu Yi2638bc32006-01-24 16:37:52 +0800423 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800424 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
425
James Ketrenos43f66a62005-03-25 12:31:53 -0600426 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800427 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
428 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600429}
430
Zhu Yic8fe6672006-01-24 16:36:36 +0800431/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600432static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
433{
434 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500435 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600436 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500437 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400438 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600439}
440
Zhu Yic8fe6672006-01-24 16:36:36 +0800441/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600442static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
443{
444 u32 value;
445
446 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
447
James Ketrenosb095c382005-08-24 22:04:42 -0500448 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
449 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600450 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
451 return value;
452}
453
Zhu Yic8fe6672006-01-24 16:36:36 +0800454/* General purpose, no alignment requirement, iterative (multi-byte) read, */
455/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600456static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
457 int num)
458{
Zhu Yi2638bc32006-01-24 16:37:52 +0800459 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600460 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600461 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400462
James Ketrenos43f66a62005-03-25 12:31:53 -0600463 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
464
James Ketrenosea2b26e2005-08-24 21:25:16 -0500465 if (num <= 0) {
466 return;
467 }
468
Zhu Yic8fe6672006-01-24 16:36:36 +0800469 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600470 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500471 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600472 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500473 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500474 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600475 aligned_addr += 4;
476 }
477
Zhu Yic8fe6672006-01-24 16:36:36 +0800478 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500479 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500480 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500481 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400482
Zhu Yic8fe6672006-01-24 16:36:36 +0800483 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500484 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500485 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500486 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500487 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500488 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600489}
490
Zhu Yic8fe6672006-01-24 16:36:36 +0800491/* General purpose, no alignment requirement, iterative (multi-byte) write, */
492/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400493static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600494 int num)
495{
Zhu Yi2638bc32006-01-24 16:37:52 +0800496 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600497 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600498 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400499
James Ketrenos43f66a62005-03-25 12:31:53 -0600500 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400501
James Ketrenosea2b26e2005-08-24 21:25:16 -0500502 if (num <= 0) {
503 return;
504 }
505
Zhu Yic8fe6672006-01-24 16:36:36 +0800506 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600507 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500508 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800509 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500510 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500511 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600512 aligned_addr += 4;
513 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400514
Zhu Yic8fe6672006-01-24 16:36:36 +0800515 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500516 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500517 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500518 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400519
Zhu Yic8fe6672006-01-24 16:36:36 +0800520 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500521 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500522 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500523 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500524 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500525 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600526}
527
Zhu Yic8fe6672006-01-24 16:36:36 +0800528/* General purpose, no alignment requirement, iterative (multi-byte) write, */
529/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400530static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600531 int num)
532{
533 memcpy_toio((priv->hw_base + addr), buf, num);
534}
535
Zhu Yic8fe6672006-01-24 16:36:36 +0800536/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600537static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
538{
539 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
540}
541
Zhu Yic8fe6672006-01-24 16:36:36 +0800542/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600543static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
544{
545 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
546}
547
Zhu Yi89c318e2006-06-08 22:19:49 -0700548static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600549{
550 if (priv->status & STATUS_INT_ENABLED)
551 return;
552 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500553 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600554}
555
Zhu Yi89c318e2006-06-08 22:19:49 -0700556static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600557{
558 if (!(priv->status & STATUS_INT_ENABLED))
559 return;
560 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500561 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600562}
563
Zhu Yi89c318e2006-06-08 22:19:49 -0700564static inline void ipw_enable_interrupts(struct ipw_priv *priv)
565{
566 unsigned long flags;
567
568 spin_lock_irqsave(&priv->irq_lock, flags);
569 __ipw_enable_interrupts(priv);
570 spin_unlock_irqrestore(&priv->irq_lock, flags);
571}
572
573static inline void ipw_disable_interrupts(struct ipw_priv *priv)
574{
575 unsigned long flags;
576
577 spin_lock_irqsave(&priv->irq_lock, flags);
578 __ipw_disable_interrupts(priv);
579 spin_unlock_irqrestore(&priv->irq_lock, flags);
580}
581
James Ketrenos43f66a62005-03-25 12:31:53 -0600582static char *ipw_error_desc(u32 val)
583{
584 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600586 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600588 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600590 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600592 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400593 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500594 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400595 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500596 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400597 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500598 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400603 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500604 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400605 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500606 return "DMA_STATUS";
607 case IPW_FW_ERROR_DINO_ERROR:
608 return "DINO_ERROR";
609 case IPW_FW_ERROR_EEPROM_ERROR:
610 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400611 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500612 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400613 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500614 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400615 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500616 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600617 }
618}
619
James Ketrenosb39860c2005-08-12 09:36:32 -0500620static void ipw_dump_error_log(struct ipw_priv *priv,
621 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600622{
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600624
James Ketrenosb39860c2005-08-12 09:36:32 -0500625 if (!error) {
626 IPW_ERROR("Error allocating and capturing error log. "
627 "Nothing to dump.\n");
628 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600629 }
630
James Ketrenosb39860c2005-08-12 09:36:32 -0500631 IPW_ERROR("Start IPW Error Log Dump:\n");
632 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
633 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600634
James Ketrenosb39860c2005-08-12 09:36:32 -0500635 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400636 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500637 ipw_error_desc(error->elem[i].desc),
638 error->elem[i].time,
639 error->elem[i].blink1,
640 error->elem[i].blink2,
641 error->elem[i].link1,
642 error->elem[i].link2, error->elem[i].data);
643 for (i = 0; i < error->log_len; i++)
644 IPW_ERROR("%i\t0x%08x\t%i\n",
645 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500646 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600647}
James Ketrenos43f66a62005-03-25 12:31:53 -0600648
James Ketrenosc848d0a2005-08-24 21:56:24 -0500649static inline int ipw_is_init(struct ipw_priv *priv)
650{
651 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600652}
653
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400654static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600655{
656 u32 addr, field_info, field_len, field_count, total_len;
657
658 IPW_DEBUG_ORD("ordinal = %i\n", ord);
659
660 if (!priv || !val || !len) {
661 IPW_DEBUG_ORD("Invalid argument\n");
662 return -EINVAL;
663 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400664
James Ketrenos43f66a62005-03-25 12:31:53 -0600665 /* verify device ordinal tables have been initialized */
666 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
667 IPW_DEBUG_ORD("Access ordinals before initialization\n");
668 return -EINVAL;
669 }
670
671 switch (IPW_ORD_TABLE_ID_MASK & ord) {
672 case IPW_ORD_TABLE_0_MASK:
673 /*
674 * TABLE 0: Direct access to a table of 32 bit values
675 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400676 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600677 * read from the table
678 */
679
680 /* remove the table id from the ordinal */
681 ord &= IPW_ORD_TABLE_VALUE_MASK;
682
683 /* boundary check */
684 if (ord > priv->table0_len) {
685 IPW_DEBUG_ORD("ordinal value (%i) longer then "
686 "max (%i)\n", ord, priv->table0_len);
687 return -EINVAL;
688 }
689
690 /* verify we have enough room to store the value */
691 if (*len < sizeof(u32)) {
692 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200693 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600694 return -EINVAL;
695 }
696
697 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400698 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600699
700 *len = sizeof(u32);
701 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400702 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600703 break;
704
705 case IPW_ORD_TABLE_1_MASK:
706 /*
707 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400708 *
709 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600710 * representing starting addr for the data (which is
711 * also a u32)
712 */
713
714 /* remove the table id from the ordinal */
715 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400716
James Ketrenos43f66a62005-03-25 12:31:53 -0600717 /* boundary check */
718 if (ord > priv->table1_len) {
719 IPW_DEBUG_ORD("ordinal value too long\n");
720 return -EINVAL;
721 }
722
723 /* verify we have enough room to store the value */
724 if (*len < sizeof(u32)) {
725 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200726 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600727 return -EINVAL;
728 }
729
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400730 *((u32 *) val) =
731 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600732 *len = sizeof(u32);
733 break;
734
735 case IPW_ORD_TABLE_2_MASK:
736 /*
737 * TABLE 2: Indirect access to a table of variable sized values
738 *
739 * This table consist of six values, each containing
740 * - dword containing the starting offset of the data
741 * - dword containing the lengh in the first 16bits
742 * and the count in the second 16bits
743 */
744
745 /* remove the table id from the ordinal */
746 ord &= IPW_ORD_TABLE_VALUE_MASK;
747
748 /* boundary check */
749 if (ord > priv->table2_len) {
750 IPW_DEBUG_ORD("ordinal value too long\n");
751 return -EINVAL;
752 }
753
754 /* get the address of statistic */
755 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400756
757 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600758 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400759 field_info =
760 ipw_read_reg32(priv,
761 priv->table2_addr + (ord << 3) +
762 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400763
James Ketrenos43f66a62005-03-25 12:31:53 -0600764 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400765 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400766
James Ketrenos43f66a62005-03-25 12:31:53 -0600767 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400768 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400769
James Ketrenos43f66a62005-03-25 12:31:53 -0600770 /* abort if not enought memory */
771 total_len = field_len * field_count;
772 if (total_len > *len) {
773 *len = total_len;
774 return -EINVAL;
775 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400776
James Ketrenos43f66a62005-03-25 12:31:53 -0600777 *len = total_len;
778 if (!total_len)
779 return 0;
780
781 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400782 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600783 addr, total_len, field_info);
784 ipw_read_indirect(priv, addr, val, total_len);
785 break;
786
787 default:
788 IPW_DEBUG_ORD("Invalid ordinal!\n");
789 return -EINVAL;
790
791 }
792
James Ketrenos43f66a62005-03-25 12:31:53 -0600793 return 0;
794}
795
796static void ipw_init_ordinals(struct ipw_priv *priv)
797{
798 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400799 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600800
801 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
802 priv->table0_addr, priv->table0_len);
803
804 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
805 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
806
807 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
808 priv->table1_addr, priv->table1_len);
809
810 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
811 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400812 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600813
814 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
815 priv->table2_addr, priv->table2_len);
816
817}
818
Adrian Bunka73e22b2006-01-21 01:39:42 +0100819static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500820{
James Ketrenosb095c382005-08-24 22:04:42 -0500821 reg &= ~IPW_START_STANDBY;
822 if (reg & IPW_GATE_ODMA)
823 reg &= ~IPW_GATE_ODMA;
824 if (reg & IPW_GATE_IDMA)
825 reg &= ~IPW_GATE_IDMA;
826 if (reg & IPW_GATE_ADMA)
827 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500828 return reg;
829}
830
831/*
832 * LED behavior:
833 * - On radio ON, turn on any LEDs that require to be on during start
834 * - On initialization, start unassociated blink
835 * - On association, disable unassociated blink
836 * - On disassociation, start unassociated blink
837 * - On radio OFF, turn off any LEDs started during radio on
838 *
839 */
Zhu Yiede61112006-01-24 16:37:10 +0800840#define LD_TIME_LINK_ON msecs_to_jiffies(300)
841#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
842#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500843
Adrian Bunka73e22b2006-01-21 01:39:42 +0100844static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500845{
846 unsigned long flags;
847 u32 led;
848
849 /* If configured to not use LEDs, or nic_type is 1,
850 * then we don't toggle a LINK led */
851 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
852 return;
853
854 spin_lock_irqsave(&priv->lock, flags);
855
856 if (!(priv->status & STATUS_RF_KILL_MASK) &&
857 !(priv->status & STATUS_LED_LINK_ON)) {
858 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500859 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500860 led |= priv->led_association_on;
861
862 led = ipw_register_toggle(led);
863
864 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500865 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500866
867 priv->status |= STATUS_LED_LINK_ON;
868
869 /* If we aren't associated, schedule turning the LED off */
870 if (!(priv->status & STATUS_ASSOCIATED))
871 queue_delayed_work(priv->workqueue,
872 &priv->led_link_off,
873 LD_TIME_LINK_ON);
874 }
875
876 spin_unlock_irqrestore(&priv->lock, flags);
877}
878
David Howellsc4028952006-11-22 14:57:56 +0000879static void ipw_bg_led_link_on(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500880{
David Howellsc4028952006-11-22 14:57:56 +0000881 struct ipw_priv *priv =
882 container_of(work, struct ipw_priv, led_link_on.work);
Zhu Yi46441512006-01-24 16:37:59 +0800883 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000884 ipw_led_link_on(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800885 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500886}
887
Adrian Bunka73e22b2006-01-21 01:39:42 +0100888static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500889{
890 unsigned long flags;
891 u32 led;
892
893 /* If configured not to use LEDs, or nic type is 1,
894 * then we don't goggle the LINK led. */
895 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
896 return;
897
898 spin_lock_irqsave(&priv->lock, flags);
899
900 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500901 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500902 led &= priv->led_association_off;
903 led = ipw_register_toggle(led);
904
905 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500906 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500907
908 IPW_DEBUG_LED("Link LED Off\n");
909
910 priv->status &= ~STATUS_LED_LINK_ON;
911
912 /* If we aren't associated and the radio is on, schedule
913 * turning the LED on (blink while unassociated) */
914 if (!(priv->status & STATUS_RF_KILL_MASK) &&
915 !(priv->status & STATUS_ASSOCIATED))
916 queue_delayed_work(priv->workqueue, &priv->led_link_on,
917 LD_TIME_LINK_OFF);
918
919 }
920
921 spin_unlock_irqrestore(&priv->lock, flags);
922}
923
David Howellsc4028952006-11-22 14:57:56 +0000924static void ipw_bg_led_link_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -0500925{
David Howellsc4028952006-11-22 14:57:56 +0000926 struct ipw_priv *priv =
927 container_of(work, struct ipw_priv, led_link_off.work);
Zhu Yi46441512006-01-24 16:37:59 +0800928 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +0000929 ipw_led_link_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +0800930 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500931}
932
Arjan van de Ven858119e2006-01-14 13:20:43 -0800933static void __ipw_led_activity_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500934{
James Ketrenosa613bff2005-08-24 21:43:11 -0500935 u32 led;
936
937 if (priv->config & CFG_NO_LED)
938 return;
939
James Ketrenosb095c382005-08-24 22:04:42 -0500940 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -0500941 return;
James Ketrenosa613bff2005-08-24 21:43:11 -0500942
943 if (!(priv->status & STATUS_LED_ACT_ON)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500944 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500945 led |= priv->led_activity_on;
946
947 led = ipw_register_toggle(led);
948
949 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500950 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500951
952 IPW_DEBUG_LED("Activity LED On\n");
953
954 priv->status |= STATUS_LED_ACT_ON;
955
James Ketrenosc848d0a2005-08-24 21:56:24 -0500956 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -0500957 queue_delayed_work(priv->workqueue, &priv->led_act_off,
958 LD_TIME_ACT_ON);
959 } else {
960 /* Reschedule LED off for full time period */
961 cancel_delayed_work(&priv->led_act_off);
962 queue_delayed_work(priv->workqueue, &priv->led_act_off,
963 LD_TIME_ACT_ON);
964 }
James Ketrenosb095c382005-08-24 22:04:42 -0500965}
James Ketrenosa613bff2005-08-24 21:43:11 -0500966
Adrian Bunka73e22b2006-01-21 01:39:42 +0100967#if 0
James Ketrenosb095c382005-08-24 22:04:42 -0500968void ipw_led_activity_on(struct ipw_priv *priv)
969{
970 unsigned long flags;
971 spin_lock_irqsave(&priv->lock, flags);
972 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -0500973 spin_unlock_irqrestore(&priv->lock, flags);
974}
Adrian Bunka73e22b2006-01-21 01:39:42 +0100975#endif /* 0 */
James Ketrenosa613bff2005-08-24 21:43:11 -0500976
Adrian Bunka73e22b2006-01-21 01:39:42 +0100977static void ipw_led_activity_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500978{
979 unsigned long flags;
980 u32 led;
981
982 if (priv->config & CFG_NO_LED)
983 return;
984
985 spin_lock_irqsave(&priv->lock, flags);
986
987 if (priv->status & STATUS_LED_ACT_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500988 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500989 led &= priv->led_activity_off;
990
991 led = ipw_register_toggle(led);
992
993 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500994 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500995
996 IPW_DEBUG_LED("Activity LED Off\n");
997
998 priv->status &= ~STATUS_LED_ACT_ON;
999 }
1000
1001 spin_unlock_irqrestore(&priv->lock, flags);
1002}
1003
David Howellsc4028952006-11-22 14:57:56 +00001004static void ipw_bg_led_activity_off(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05001005{
David Howellsc4028952006-11-22 14:57:56 +00001006 struct ipw_priv *priv =
1007 container_of(work, struct ipw_priv, led_act_off.work);
Zhu Yi46441512006-01-24 16:37:59 +08001008 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00001009 ipw_led_activity_off(priv);
Zhu Yi46441512006-01-24 16:37:59 +08001010 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05001011}
1012
Adrian Bunka73e22b2006-01-21 01:39:42 +01001013static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001014{
1015 unsigned long flags;
1016 u32 led;
1017
1018 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001019 if (priv->config & CFG_NO_LED ||
1020 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001021 return;
1022
1023 spin_lock_irqsave(&priv->lock, flags);
1024
James Ketrenosb095c382005-08-24 22:04:42 -05001025 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001026 if (priv->assoc_network->mode == IEEE_A) {
1027 led |= priv->led_ofdm_on;
1028 led &= priv->led_association_off;
1029 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1030 } else if (priv->assoc_network->mode == IEEE_G) {
1031 led |= priv->led_ofdm_on;
1032 led |= priv->led_association_on;
1033 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1034 } else {
1035 led &= priv->led_ofdm_off;
1036 led |= priv->led_association_on;
1037 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1038 }
1039
1040 led = ipw_register_toggle(led);
1041
1042 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001043 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001044
1045 spin_unlock_irqrestore(&priv->lock, flags);
1046}
1047
Adrian Bunka73e22b2006-01-21 01:39:42 +01001048static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001049{
1050 unsigned long flags;
1051 u32 led;
1052
1053 /* Only nic type 1 supports mode LEDs */
1054 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1055 return;
1056
1057 spin_lock_irqsave(&priv->lock, flags);
1058
James Ketrenosb095c382005-08-24 22:04:42 -05001059 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001060 led &= priv->led_ofdm_off;
1061 led &= priv->led_association_off;
1062
1063 led = ipw_register_toggle(led);
1064
1065 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001066 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001067
1068 spin_unlock_irqrestore(&priv->lock, flags);
1069}
1070
Adrian Bunka73e22b2006-01-21 01:39:42 +01001071static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001072{
1073 ipw_led_link_on(priv);
1074}
1075
Adrian Bunka73e22b2006-01-21 01:39:42 +01001076static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001077{
1078 ipw_led_activity_off(priv);
1079 ipw_led_link_off(priv);
1080}
1081
Adrian Bunka73e22b2006-01-21 01:39:42 +01001082static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001083{
1084 /* Set the Link Led on for all nic types */
1085 ipw_led_link_on(priv);
1086}
1087
Adrian Bunka73e22b2006-01-21 01:39:42 +01001088static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001089{
1090 ipw_led_activity_off(priv);
1091 ipw_led_link_off(priv);
1092
1093 if (priv->status & STATUS_RF_KILL_MASK)
1094 ipw_led_radio_off(priv);
1095}
1096
Adrian Bunka73e22b2006-01-21 01:39:42 +01001097static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001098{
1099 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1100
1101 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001102 priv->led_activity_on = IPW_ACTIVITY_LED;
1103 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001104
James Ketrenosb095c382005-08-24 22:04:42 -05001105 priv->led_association_on = IPW_ASSOCIATED_LED;
1106 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001107
1108 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001109 priv->led_ofdm_on = IPW_OFDM_LED;
1110 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001111
1112 switch (priv->nic_type) {
1113 case EEPROM_NIC_TYPE_1:
1114 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001115 priv->led_activity_on = IPW_ASSOCIATED_LED;
1116 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1117 priv->led_association_on = IPW_ACTIVITY_LED;
1118 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001119
1120 if (!(priv->config & CFG_NO_LED))
1121 ipw_led_band_on(priv);
1122
1123 /* And we don't blink link LEDs for this nic, so
1124 * just return here */
1125 return;
1126
1127 case EEPROM_NIC_TYPE_3:
1128 case EEPROM_NIC_TYPE_2:
1129 case EEPROM_NIC_TYPE_4:
1130 case EEPROM_NIC_TYPE_0:
1131 break;
1132
1133 default:
1134 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1135 priv->nic_type);
1136 priv->nic_type = EEPROM_NIC_TYPE_0;
1137 break;
1138 }
1139
1140 if (!(priv->config & CFG_NO_LED)) {
1141 if (priv->status & STATUS_ASSOCIATED)
1142 ipw_led_link_on(priv);
1143 else
1144 ipw_led_link_off(priv);
1145 }
1146}
1147
Adrian Bunka73e22b2006-01-21 01:39:42 +01001148static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001149{
James Ketrenosa613bff2005-08-24 21:43:11 -05001150 ipw_led_activity_off(priv);
1151 ipw_led_link_off(priv);
1152 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001153 cancel_delayed_work(&priv->led_link_on);
1154 cancel_delayed_work(&priv->led_link_off);
1155 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001156}
1157
James Ketrenos43f66a62005-03-25 12:31:53 -06001158/*
1159 * The following adds a new attribute to the sysfs representation
1160 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1161 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001162 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001163 * See the level definitions in ipw for details.
1164 */
1165static ssize_t show_debug_level(struct device_driver *d, char *buf)
1166{
1167 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1168}
James Ketrenosa613bff2005-08-24 21:43:11 -05001169
1170static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1171 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001172{
1173 char *p = (char *)buf;
1174 u32 val;
1175
1176 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1177 p++;
1178 if (p[0] == 'x' || p[0] == 'X')
1179 p++;
1180 val = simple_strtoul(p, &p, 16);
1181 } else
1182 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001183 if (p == buf)
1184 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001185 ": %s is not in hex or decimal form.\n", buf);
1186 else
1187 ipw_debug_level = val;
1188
1189 return strnlen(buf, count);
1190}
1191
Jeff Garzikbf794512005-07-31 13:07:26 -04001192static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001193 show_debug_level, store_debug_level);
1194
James Ketrenosb39860c2005-08-12 09:36:32 -05001195static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1196{
Zhu Yic8fe6672006-01-24 16:36:36 +08001197 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001198 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1199}
1200
1201static void ipw_capture_event_log(struct ipw_priv *priv,
1202 u32 log_len, struct ipw_event *log)
1203{
1204 u32 base;
1205
1206 if (log_len) {
1207 base = ipw_read32(priv, IPW_EVENT_LOG);
1208 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1209 (u8 *) log, sizeof(*log) * log_len);
1210 }
1211}
1212
1213static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1214{
1215 struct ipw_fw_error *error;
1216 u32 log_len = ipw_get_event_log_len(priv);
1217 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1218 u32 elem_len = ipw_read_reg32(priv, base);
1219
1220 error = kmalloc(sizeof(*error) +
1221 sizeof(*error->elem) * elem_len +
1222 sizeof(*error->log) * log_len, GFP_ATOMIC);
1223 if (!error) {
1224 IPW_ERROR("Memory allocation for firmware error log "
1225 "failed.\n");
1226 return NULL;
1227 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001228 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001229 error->status = priv->status;
1230 error->config = priv->config;
1231 error->elem_len = elem_len;
1232 error->log_len = log_len;
1233 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001234 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001235
1236 ipw_capture_event_log(priv, log_len, error->log);
1237
1238 if (elem_len)
1239 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1240 sizeof(*error->elem) * elem_len);
1241
1242 return error;
1243}
1244
James Ketrenosb39860c2005-08-12 09:36:32 -05001245static ssize_t show_event_log(struct device *d,
1246 struct device_attribute *attr, char *buf)
1247{
1248 struct ipw_priv *priv = dev_get_drvdata(d);
1249 u32 log_len = ipw_get_event_log_len(priv);
Reinette Chatre412e9e72007-12-18 22:01:02 -08001250 u32 log_size;
1251 struct ipw_event *log;
James Ketrenosb39860c2005-08-12 09:36:32 -05001252 u32 len = 0, i;
1253
Reinette Chatre412e9e72007-12-18 22:01:02 -08001254 /* not using min() because of its strict type checking */
1255 log_size = PAGE_SIZE / sizeof(*log) > log_len ?
1256 sizeof(*log) * log_len : PAGE_SIZE;
1257 log = kzalloc(log_size, GFP_KERNEL);
1258 if (!log) {
1259 IPW_ERROR("Unable to allocate memory for log\n");
1260 return 0;
1261 }
1262 log_len = log_size / sizeof(*log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001263 ipw_capture_event_log(priv, log_len, log);
1264
1265 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1266 for (i = 0; i < log_len; i++)
1267 len += snprintf(buf + len, PAGE_SIZE - len,
1268 "\n%08X%08X%08X",
1269 log[i].time, log[i].event, log[i].data);
1270 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
Reinette Chatre412e9e72007-12-18 22:01:02 -08001271 kfree(log);
James Ketrenosb39860c2005-08-12 09:36:32 -05001272 return len;
1273}
1274
1275static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1276
1277static ssize_t show_error(struct device *d,
1278 struct device_attribute *attr, char *buf)
1279{
1280 struct ipw_priv *priv = dev_get_drvdata(d);
1281 u32 len = 0, i;
1282 if (!priv->error)
1283 return 0;
1284 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001285 "%08lX%08X%08X%08X",
1286 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001287 priv->error->status,
1288 priv->error->config, priv->error->elem_len);
1289 for (i = 0; i < priv->error->elem_len; i++)
1290 len += snprintf(buf + len, PAGE_SIZE - len,
1291 "\n%08X%08X%08X%08X%08X%08X%08X",
1292 priv->error->elem[i].time,
1293 priv->error->elem[i].desc,
1294 priv->error->elem[i].blink1,
1295 priv->error->elem[i].blink2,
1296 priv->error->elem[i].link1,
1297 priv->error->elem[i].link2,
1298 priv->error->elem[i].data);
1299
1300 len += snprintf(buf + len, PAGE_SIZE - len,
1301 "\n%08X", priv->error->log_len);
1302 for (i = 0; i < priv->error->log_len; i++)
1303 len += snprintf(buf + len, PAGE_SIZE - len,
1304 "\n%08X%08X%08X",
1305 priv->error->log[i].time,
1306 priv->error->log[i].event,
1307 priv->error->log[i].data);
1308 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1309 return len;
1310}
1311
1312static ssize_t clear_error(struct device *d,
1313 struct device_attribute *attr,
1314 const char *buf, size_t count)
1315{
1316 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001317
1318 kfree(priv->error);
1319 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001320 return count;
1321}
1322
1323static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1324
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001325static ssize_t show_cmd_log(struct device *d,
1326 struct device_attribute *attr, char *buf)
1327{
1328 struct ipw_priv *priv = dev_get_drvdata(d);
1329 u32 len = 0, i;
1330 if (!priv->cmdlog)
1331 return 0;
1332 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1333 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1334 i = (i + 1) % priv->cmdlog_len) {
1335 len +=
1336 snprintf(buf + len, PAGE_SIZE - len,
1337 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1338 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1339 priv->cmdlog[i].cmd.len);
1340 len +=
1341 snprintk_buf(buf + len, PAGE_SIZE - len,
1342 (u8 *) priv->cmdlog[i].cmd.param,
1343 priv->cmdlog[i].cmd.len);
1344 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1345 }
1346 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1347 return len;
1348}
1349
1350static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1351
Zhu Yid685b8c2006-04-13 17:20:27 +08001352#ifdef CONFIG_IPW2200_PROMISCUOUS
1353static void ipw_prom_free(struct ipw_priv *priv);
1354static int ipw_prom_alloc(struct ipw_priv *priv);
1355static ssize_t store_rtap_iface(struct device *d,
1356 struct device_attribute *attr,
1357 const char *buf, size_t count)
1358{
1359 struct ipw_priv *priv = dev_get_drvdata(d);
1360 int rc = 0;
1361
1362 if (count < 1)
1363 return -EINVAL;
1364
1365 switch (buf[0]) {
1366 case '0':
1367 if (!rtap_iface)
1368 return count;
1369
1370 if (netif_running(priv->prom_net_dev)) {
1371 IPW_WARNING("Interface is up. Cannot unregister.\n");
1372 return count;
1373 }
1374
1375 ipw_prom_free(priv);
1376 rtap_iface = 0;
1377 break;
1378
1379 case '1':
1380 if (rtap_iface)
1381 return count;
1382
1383 rc = ipw_prom_alloc(priv);
1384 if (!rc)
1385 rtap_iface = 1;
1386 break;
1387
1388 default:
1389 return -EINVAL;
1390 }
1391
1392 if (rc) {
1393 IPW_ERROR("Failed to register promiscuous network "
1394 "device (error %d).\n", rc);
1395 }
1396
1397 return count;
1398}
1399
1400static ssize_t show_rtap_iface(struct device *d,
1401 struct device_attribute *attr,
1402 char *buf)
1403{
1404 struct ipw_priv *priv = dev_get_drvdata(d);
1405 if (rtap_iface)
1406 return sprintf(buf, "%s", priv->prom_net_dev->name);
1407 else {
1408 buf[0] = '-';
1409 buf[1] = '1';
1410 buf[2] = '\0';
1411 return 3;
1412 }
1413}
1414
1415static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1416 store_rtap_iface);
1417
1418static ssize_t store_rtap_filter(struct device *d,
1419 struct device_attribute *attr,
1420 const char *buf, size_t count)
1421{
1422 struct ipw_priv *priv = dev_get_drvdata(d);
1423
1424 if (!priv->prom_priv) {
1425 IPW_ERROR("Attempting to set filter without "
1426 "rtap_iface enabled.\n");
1427 return -EPERM;
1428 }
1429
1430 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1431
1432 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1433 BIT_ARG16(priv->prom_priv->filter));
1434
1435 return count;
1436}
1437
1438static ssize_t show_rtap_filter(struct device *d,
1439 struct device_attribute *attr,
1440 char *buf)
1441{
1442 struct ipw_priv *priv = dev_get_drvdata(d);
1443 return sprintf(buf, "0x%04X",
1444 priv->prom_priv ? priv->prom_priv->filter : 0);
1445}
1446
1447static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1448 store_rtap_filter);
1449#endif
1450
James Ketrenosa613bff2005-08-24 21:43:11 -05001451static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1452 char *buf)
1453{
1454 struct ipw_priv *priv = dev_get_drvdata(d);
1455 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1456}
1457
1458static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1459 const char *buf, size_t count)
1460{
1461 struct ipw_priv *priv = dev_get_drvdata(d);
1462 struct net_device *dev = priv->net_dev;
1463 char buffer[] = "00000000";
1464 unsigned long len =
1465 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1466 unsigned long val;
1467 char *p = buffer;
1468
1469 IPW_DEBUG_INFO("enter\n");
1470
1471 strncpy(buffer, buf, len);
1472 buffer[len] = 0;
1473
1474 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1475 p++;
1476 if (p[0] == 'x' || p[0] == 'X')
1477 p++;
1478 val = simple_strtoul(p, &p, 16);
1479 } else
1480 val = simple_strtoul(p, &p, 10);
1481 if (p == buffer) {
1482 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1483 } else {
1484 priv->ieee->scan_age = val;
1485 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1486 }
1487
1488 IPW_DEBUG_INFO("exit\n");
1489 return len;
1490}
1491
1492static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1493
1494static ssize_t show_led(struct device *d, struct device_attribute *attr,
1495 char *buf)
1496{
1497 struct ipw_priv *priv = dev_get_drvdata(d);
1498 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1499}
1500
1501static ssize_t store_led(struct device *d, struct device_attribute *attr,
1502 const char *buf, size_t count)
1503{
1504 struct ipw_priv *priv = dev_get_drvdata(d);
1505
1506 IPW_DEBUG_INFO("enter\n");
1507
1508 if (count == 0)
1509 return 0;
1510
1511 if (*buf == 0) {
1512 IPW_DEBUG_LED("Disabling LED control.\n");
1513 priv->config |= CFG_NO_LED;
1514 ipw_led_shutdown(priv);
1515 } else {
1516 IPW_DEBUG_LED("Enabling LED control.\n");
1517 priv->config &= ~CFG_NO_LED;
1518 ipw_led_init(priv);
1519 }
1520
1521 IPW_DEBUG_INFO("exit\n");
1522 return count;
1523}
1524
1525static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1526
Andrew Mortonad3fee52005-06-20 14:30:36 -07001527static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001528 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001529{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001530 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001531 return sprintf(buf, "0x%08x\n", (int)p->status);
1532}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001533
James Ketrenos43f66a62005-03-25 12:31:53 -06001534static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1535
Andrew Mortonad3fee52005-06-20 14:30:36 -07001536static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1537 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001538{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001539 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001540 return sprintf(buf, "0x%08x\n", (int)p->config);
1541}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001542
James Ketrenos43f66a62005-03-25 12:31:53 -06001543static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1544
Andrew Mortonad3fee52005-06-20 14:30:36 -07001545static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001546 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001547{
James Ketrenosa613bff2005-08-24 21:43:11 -05001548 struct ipw_priv *priv = d->driver_data;
1549 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001550}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001551
James Ketrenos43f66a62005-03-25 12:31:53 -06001552static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1553
Andrew Mortonad3fee52005-06-20 14:30:36 -07001554static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001555 struct device_attribute *attr, 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_UCODE_VERSION, &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(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001567
Andrew Mortonad3fee52005-06-20 14:30:36 -07001568static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1569 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001570{
1571 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001572 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001573
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001574 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001575 return 0;
1576
1577 return sprintf(buf, "0x%08x\n", tmp);
1578}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001579
1580static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001581
1582/*
1583 * Add a device attribute to view/control the delay between eeprom
1584 * operations.
1585 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001586static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001587 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001588{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001589 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001590 return sprintf(buf, "%i\n", n);
1591}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001592static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001593 struct device_attribute *attr,
1594 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001595{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001596 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001597 sscanf(buf, "%i", &p->eeprom_delay);
1598 return strnlen(buf, count);
1599}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001600
1601static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1602 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001603
Andrew Mortonad3fee52005-06-20 14:30:36 -07001604static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001605 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001606{
1607 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001608 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001609
James Ketrenosb095c382005-08-24 22:04:42 -05001610 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001611 return sprintf(buf, "0x%08x\n", reg);
1612}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001613static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001614 struct device_attribute *attr,
1615 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001616{
1617 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001618 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001619
1620 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001621 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001622 return strnlen(buf, count);
1623}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001624
1625static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1626 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001627
Andrew Mortonad3fee52005-06-20 14:30:36 -07001628static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001629 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001630{
1631 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001632 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001633
1634 reg = ipw_read_reg32(p, 0x301100);
1635 return sprintf(buf, "0x%08x\n", reg);
1636}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001637static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001638 struct device_attribute *attr,
1639 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001640{
1641 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001642 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001643
1644 sscanf(buf, "%x", &reg);
1645 ipw_write_reg32(p, 0x301100, reg);
1646 return strnlen(buf, count);
1647}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001648
1649static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1650 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001651
Andrew Mortonad3fee52005-06-20 14:30:36 -07001652static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001653 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001654{
1655 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001656 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001657
Jeff Garzikbf794512005-07-31 13:07:26 -04001658 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001659 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001660 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001661 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001662
James Ketrenos43f66a62005-03-25 12:31:53 -06001663 return sprintf(buf, "0x%08x\n", reg);
1664}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001665static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001666 struct device_attribute *attr,
1667 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001668{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001669 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001670
1671 sscanf(buf, "%x", &priv->indirect_dword);
1672 priv->status |= STATUS_INDIRECT_DWORD;
1673 return strnlen(buf, count);
1674}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001675
1676static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1677 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001678
Andrew Mortonad3fee52005-06-20 14:30:36 -07001679static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001680 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001681{
1682 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001683 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001684
Jeff Garzikbf794512005-07-31 13:07:26 -04001685 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001686 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001687 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001688 reg = 0;
1689
1690 return sprintf(buf, "0x%02x\n", reg);
1691}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001692static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001693 struct device_attribute *attr,
1694 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001695{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001696 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001697
1698 sscanf(buf, "%x", &priv->indirect_byte);
1699 priv->status |= STATUS_INDIRECT_BYTE;
1700 return strnlen(buf, count);
1701}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001702
1703static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001704 show_indirect_byte, store_indirect_byte);
1705
Andrew Mortonad3fee52005-06-20 14:30:36 -07001706static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001707 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001708{
1709 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001710 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001711
Jeff Garzikbf794512005-07-31 13:07:26 -04001712 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001713 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001714 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001715 reg = 0;
1716
1717 return sprintf(buf, "0x%08x\n", reg);
1718}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001719static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001720 struct device_attribute *attr,
1721 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001722{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001723 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001724
1725 sscanf(buf, "%x", &priv->direct_dword);
1726 priv->status |= STATUS_DIRECT_DWORD;
1727 return strnlen(buf, count);
1728}
James Ketrenos43f66a62005-03-25 12:31:53 -06001729
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001730static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1731 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001732
Arjan van de Ven858119e2006-01-14 13:20:43 -08001733static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001734{
1735 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1736 priv->status |= STATUS_RF_KILL_HW;
1737 else
1738 priv->status &= ~STATUS_RF_KILL_HW;
1739
1740 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1741}
1742
Andrew Mortonad3fee52005-06-20 14:30:36 -07001743static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001744 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001745{
1746 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001747 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001748 2 - HW based RF kill active
1749 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001750 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001751 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001752 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001753 return sprintf(buf, "%i\n", val);
1754}
1755
1756static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1757{
Jeff Garzikbf794512005-07-31 13:07:26 -04001758 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001759 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001760 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001761
1762 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1763 disable_radio ? "OFF" : "ON");
1764
1765 if (disable_radio) {
1766 priv->status |= STATUS_RF_KILL_SW;
1767
Dan Williams0b531672007-10-09 13:55:24 -04001768 if (priv->workqueue) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001769 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -04001770 cancel_delayed_work(&priv->request_direct_scan);
1771 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -04001772 cancel_delayed_work(&priv->scan_event);
1773 }
James Ketrenos43f66a62005-03-25 12:31:53 -06001774 queue_work(priv->workqueue, &priv->down);
1775 } else {
1776 priv->status &= ~STATUS_RF_KILL_SW;
1777 if (rf_kill_active(priv)) {
1778 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1779 "disabled by HW switch\n");
1780 /* Make sure the RF_KILL check timer is running */
1781 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001782 queue_delayed_work(priv->workqueue, &priv->rf_kill,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05001783 round_jiffies_relative(2 * HZ));
Jeff Garzikbf794512005-07-31 13:07:26 -04001784 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001785 queue_work(priv->workqueue, &priv->up);
1786 }
1787
1788 return 1;
1789}
1790
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001791static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1792 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001793{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001794 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001795
James Ketrenos43f66a62005-03-25 12:31:53 -06001796 ipw_radio_kill_sw(priv, buf[0] == '1');
1797
1798 return count;
1799}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001800
1801static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001802
James Ketrenosb095c382005-08-24 22:04:42 -05001803static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1804 char *buf)
1805{
1806 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1807 int pos = 0, len = 0;
1808 if (priv->config & CFG_SPEED_SCAN) {
1809 while (priv->speed_scan[pos] != 0)
1810 len += sprintf(&buf[len], "%d ",
1811 priv->speed_scan[pos++]);
1812 return len + sprintf(&buf[len], "\n");
1813 }
1814
1815 return sprintf(buf, "0\n");
1816}
1817
1818static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1819 const char *buf, size_t count)
1820{
1821 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1822 int channel, pos = 0;
1823 const char *p = buf;
1824
1825 /* list of space separated channels to scan, optionally ending with 0 */
1826 while ((channel = simple_strtol(p, NULL, 0))) {
1827 if (pos == MAX_SPEED_SCAN - 1) {
1828 priv->speed_scan[pos] = 0;
1829 break;
1830 }
1831
Larry Finger1867b112006-02-28 09:48:28 -06001832 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001833 priv->speed_scan[pos++] = channel;
1834 else
1835 IPW_WARNING("Skipping invalid channel request: %d\n",
1836 channel);
1837 p = strchr(p, ' ');
1838 if (!p)
1839 break;
1840 while (*p == ' ' || *p == '\t')
1841 p++;
1842 }
1843
1844 if (pos == 0)
1845 priv->config &= ~CFG_SPEED_SCAN;
1846 else {
1847 priv->speed_scan_pos = 0;
1848 priv->config |= CFG_SPEED_SCAN;
1849 }
1850
1851 return count;
1852}
1853
1854static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1855 store_speed_scan);
1856
1857static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1858 char *buf)
1859{
1860 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1861 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1862}
1863
1864static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1865 const char *buf, size_t count)
1866{
1867 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1868 if (buf[0] == '1')
1869 priv->config |= CFG_NET_STATS;
1870 else
1871 priv->config &= ~CFG_NET_STATS;
1872
1873 return count;
1874}
1875
James Ketrenosafbf30a2005-08-25 00:05:33 -05001876static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1877 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001878
Zhu Yi375dd242007-02-14 16:04:24 +08001879static ssize_t show_channels(struct device *d,
1880 struct device_attribute *attr,
1881 char *buf)
1882{
1883 struct ipw_priv *priv = dev_get_drvdata(d);
Andrew Morton742e9912007-03-01 08:19:29 -05001884 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi375dd242007-02-14 16:04:24 +08001885 int len = 0, i;
1886
1887 len = sprintf(&buf[len],
1888 "Displaying %d channels in 2.4Ghz band "
1889 "(802.11bg):\n", geo->bg_channels);
1890
1891 for (i = 0; i < geo->bg_channels; i++) {
1892 len += sprintf(&buf[len], "%d: BSS%s%s, %s, Band %s.\n",
1893 geo->bg[i].channel,
1894 geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT ?
1895 " (radar spectrum)" : "",
1896 ((geo->bg[i].flags & IEEE80211_CH_NO_IBSS) ||
1897 (geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT))
1898 ? "" : ", IBSS",
1899 geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1900 "passive only" : "active/passive",
1901 geo->bg[i].flags & IEEE80211_CH_B_ONLY ?
1902 "B" : "B/G");
1903 }
1904
1905 len += sprintf(&buf[len],
1906 "Displaying %d channels in 5.2Ghz band "
1907 "(802.11a):\n", geo->a_channels);
1908 for (i = 0; i < geo->a_channels; i++) {
1909 len += sprintf(&buf[len], "%d: BSS%s%s, %s.\n",
1910 geo->a[i].channel,
1911 geo->a[i].flags & IEEE80211_CH_RADAR_DETECT ?
1912 " (radar spectrum)" : "",
1913 ((geo->a[i].flags & IEEE80211_CH_NO_IBSS) ||
1914 (geo->a[i].flags & IEEE80211_CH_RADAR_DETECT))
1915 ? "" : ", IBSS",
1916 geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1917 "passive only" : "active/passive");
1918 }
1919
1920 return len;
1921}
1922
1923static DEVICE_ATTR(channels, S_IRUSR, show_channels, NULL);
1924
James Ketrenosea2b26e2005-08-24 21:25:16 -05001925static void notify_wx_assoc_event(struct ipw_priv *priv)
1926{
1927 union iwreq_data wrqu;
1928 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1929 if (priv->status & STATUS_ASSOCIATED)
1930 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1931 else
1932 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1933 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1934}
1935
James Ketrenos43f66a62005-03-25 12:31:53 -06001936static void ipw_irq_tasklet(struct ipw_priv *priv)
1937{
1938 u32 inta, inta_mask, handled = 0;
1939 unsigned long flags;
1940 int rc = 0;
1941
Zhu Yi89c318e2006-06-08 22:19:49 -07001942 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001943
James Ketrenosb095c382005-08-24 22:04:42 -05001944 inta = ipw_read32(priv, IPW_INTA_RW);
1945 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1946 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001947
1948 /* Add any cached INTA values that need to be handled */
1949 inta |= priv->isr_inta;
1950
Zhu Yi89c318e2006-06-08 22:19:49 -07001951 spin_unlock_irqrestore(&priv->irq_lock, flags);
1952
1953 spin_lock_irqsave(&priv->lock, flags);
1954
James Ketrenos43f66a62005-03-25 12:31:53 -06001955 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001956 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001957 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001958 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001959 }
1960
James Ketrenosb095c382005-08-24 22:04:42 -05001961 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001962 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001963 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001964 priv->status &= ~STATUS_HCMD_ACTIVE;
1965 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001966 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001967 }
1968
James Ketrenosb095c382005-08-24 22:04:42 -05001969 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001970 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001971 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001972 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001973 }
1974
James Ketrenosb095c382005-08-24 22:04:42 -05001975 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001976 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001977 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001978 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001979 }
1980
James Ketrenosb095c382005-08-24 22:04:42 -05001981 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001982 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001983 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001984 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001985 }
1986
James Ketrenosb095c382005-08-24 22:04:42 -05001987 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001988 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001989 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001990 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001991 }
1992
James Ketrenosb095c382005-08-24 22:04:42 -05001993 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001994 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001995 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001996 }
1997
James Ketrenosb095c382005-08-24 22:04:42 -05001998 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001999 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002000 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06002001 }
2002
James Ketrenosb095c382005-08-24 22:04:42 -05002003 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002004 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002005 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002006 }
2007
James Ketrenosb095c382005-08-24 22:04:42 -05002008 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002009 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002010 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002011 }
2012
James Ketrenosb095c382005-08-24 22:04:42 -05002013 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002014 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002015 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002016 }
2017
James Ketrenosb095c382005-08-24 22:04:42 -05002018 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002019 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
2020 priv->status |= STATUS_RF_KILL_HW;
2021 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05002022 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06002023 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -04002024 cancel_delayed_work(&priv->request_direct_scan);
2025 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -04002026 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -05002027 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06002028 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05002029 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002030 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002031
James Ketrenosb095c382005-08-24 22:04:42 -05002032 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002033 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002034 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002035 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002036 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
2037 struct ipw_fw_error *error =
2038 ipw_alloc_error_log(priv);
2039 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07002040 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002041 }
James Ketrenosb39860c2005-08-12 09:36:32 -05002042 } else {
2043 priv->error = ipw_alloc_error_log(priv);
2044 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002045 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002046 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002047 IPW_DEBUG_FW("Error allocating sysfs 'error' "
2048 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002049 if (ipw_debug_level & IPW_DL_FW_ERRORS)
2050 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002051 }
2052
James Ketrenosb095c382005-08-24 22:04:42 -05002053 /* XXX: If hardware encryption is for WPA/WPA2,
2054 * we have to notify the supplicant. */
2055 if (priv->ieee->sec.encrypt) {
2056 priv->status &= ~STATUS_ASSOCIATED;
2057 notify_wx_assoc_event(priv);
2058 }
2059
2060 /* Keep the restart process from trying to send host
2061 * commands by clearing the INIT status bit */
2062 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05002063
2064 /* Cancel currently queued command. */
2065 priv->status &= ~STATUS_HCMD_ACTIVE;
2066 wake_up_interruptible(&priv->wait_command_queue);
2067
James Ketrenos43f66a62005-03-25 12:31:53 -06002068 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05002069 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002070 }
2071
James Ketrenosb095c382005-08-24 22:04:42 -05002072 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002073 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002074 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002075 }
2076
2077 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002078 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002079 }
2080
Zhu Yi89c318e2006-06-08 22:19:49 -07002081 spin_unlock_irqrestore(&priv->lock, flags);
2082
James Ketrenos43f66a62005-03-25 12:31:53 -06002083 /* enable all interrupts */
2084 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002085}
Jeff Garzikbf794512005-07-31 13:07:26 -04002086
James Ketrenos43f66a62005-03-25 12:31:53 -06002087#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2088static char *get_cmd_string(u8 cmd)
2089{
2090 switch (cmd) {
2091 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002092 IPW_CMD(POWER_DOWN);
2093 IPW_CMD(SYSTEM_CONFIG);
2094 IPW_CMD(MULTICAST_ADDRESS);
2095 IPW_CMD(SSID);
2096 IPW_CMD(ADAPTER_ADDRESS);
2097 IPW_CMD(PORT_TYPE);
2098 IPW_CMD(RTS_THRESHOLD);
2099 IPW_CMD(FRAG_THRESHOLD);
2100 IPW_CMD(POWER_MODE);
2101 IPW_CMD(WEP_KEY);
2102 IPW_CMD(TGI_TX_KEY);
2103 IPW_CMD(SCAN_REQUEST);
2104 IPW_CMD(SCAN_REQUEST_EXT);
2105 IPW_CMD(ASSOCIATE);
2106 IPW_CMD(SUPPORTED_RATES);
2107 IPW_CMD(SCAN_ABORT);
2108 IPW_CMD(TX_FLUSH);
2109 IPW_CMD(QOS_PARAMETERS);
2110 IPW_CMD(DINO_CONFIG);
2111 IPW_CMD(RSN_CAPABILITIES);
2112 IPW_CMD(RX_KEY);
2113 IPW_CMD(CARD_DISABLE);
2114 IPW_CMD(SEED_NUMBER);
2115 IPW_CMD(TX_POWER);
2116 IPW_CMD(COUNTRY_INFO);
2117 IPW_CMD(AIRONET_INFO);
2118 IPW_CMD(AP_TX_POWER);
2119 IPW_CMD(CCKM_INFO);
2120 IPW_CMD(CCX_VER_INFO);
2121 IPW_CMD(SET_CALIBRATION);
2122 IPW_CMD(SENSITIVITY_CALIB);
2123 IPW_CMD(RETRY_LIMIT);
2124 IPW_CMD(IPW_PRE_POWER_DOWN);
2125 IPW_CMD(VAP_BEACON_TEMPLATE);
2126 IPW_CMD(VAP_DTIM_PERIOD);
2127 IPW_CMD(EXT_SUPPORTED_RATES);
2128 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2129 IPW_CMD(VAP_QUIET_INTERVALS);
2130 IPW_CMD(VAP_CHANNEL_SWITCH);
2131 IPW_CMD(VAP_MANDATORY_CHANNELS);
2132 IPW_CMD(VAP_CELL_PWR_LIMIT);
2133 IPW_CMD(VAP_CF_PARAM_SET);
2134 IPW_CMD(VAP_SET_BEACONING_STATE);
2135 IPW_CMD(MEASUREMENT);
2136 IPW_CMD(POWER_CAPABILITY);
2137 IPW_CMD(SUPPORTED_CHANNELS);
2138 IPW_CMD(TPC_REPORT);
2139 IPW_CMD(WME_INFO);
2140 IPW_CMD(PRODUCTION_COMMAND);
2141 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002142 return "UNKNOWN";
2143 }
2144}
James Ketrenos43f66a62005-03-25 12:31:53 -06002145
2146#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002147
2148static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002149{
2150 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002151 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002152
James Ketrenosa613bff2005-08-24 21:43:11 -05002153 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002154 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002155 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2156 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002157 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002158 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002159 }
2160
2161 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002162
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002163 if (priv->cmdlog) {
2164 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2165 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2166 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2167 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2168 cmd->len);
2169 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2170 }
2171
James Ketrenosb095c382005-08-24 22:04:42 -05002172 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2173 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2174 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002175
2176#ifndef DEBUG_CMD_WEP_KEY
2177 if (cmd->cmd == IPW_CMD_WEP_KEY)
2178 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2179 else
2180#endif
2181 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2182
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002183 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002184 if (rc) {
2185 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002186 IPW_ERROR("Failed to send %s: Reason %d\n",
2187 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002188 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002189 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002190 }
2191 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002192
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002193 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2194 !(priv->
2195 status & STATUS_HCMD_ACTIVE),
2196 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002197 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002198 spin_lock_irqsave(&priv->lock, flags);
2199 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002200 IPW_ERROR("Failed to send %s: Command timed out.\n",
2201 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002202 priv->status &= ~STATUS_HCMD_ACTIVE;
2203 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002204 rc = -EIO;
2205 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002206 }
2207 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002208 } else
2209 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002210
James Ketrenosb095c382005-08-24 22:04:42 -05002211 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002212 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2213 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002214 rc = -EIO;
2215 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002216 }
2217
Zhu Yi2638bc32006-01-24 16:37:52 +08002218 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002219 if (priv->cmdlog) {
2220 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2221 priv->cmdlog_pos %= priv->cmdlog_len;
2222 }
2223 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002224}
2225
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002226static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002227{
2228 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002229 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002230 };
2231
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002232 return __ipw_send_cmd(priv, &cmd);
2233}
2234
2235static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2236 void *data)
2237{
2238 struct host_cmd cmd = {
2239 .cmd = command,
2240 .len = len,
2241 .param = data,
2242 };
2243
2244 return __ipw_send_cmd(priv, &cmd);
2245}
2246
2247static int ipw_send_host_complete(struct ipw_priv *priv)
2248{
James Ketrenos43f66a62005-03-25 12:31:53 -06002249 if (!priv) {
2250 IPW_ERROR("Invalid args\n");
2251 return -1;
2252 }
2253
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002254 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002255}
2256
Zhu Yid685b8c2006-04-13 17:20:27 +08002257static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002258{
Zhu Yid685b8c2006-04-13 17:20:27 +08002259 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2260 sizeof(priv->sys_config),
2261 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002262}
2263
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002264static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002265{
James Ketrenos43f66a62005-03-25 12:31:53 -06002266 if (!priv || !ssid) {
2267 IPW_ERROR("Invalid args\n");
2268 return -1;
2269 }
2270
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002271 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002272 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002273}
2274
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002275static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002276{
James Ketrenos43f66a62005-03-25 12:31:53 -06002277 if (!priv || !mac) {
2278 IPW_ERROR("Invalid args\n");
2279 return -1;
2280 }
2281
Johannes Berge1749612008-10-27 15:59:26 -07002282 IPW_DEBUG_INFO("%s: Setting MAC to %pM\n",
2283 priv->net_dev->name, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002284
Zhu Yi2638bc32006-01-24 16:37:52 +08002285 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002286}
2287
James Ketrenosa613bff2005-08-24 21:43:11 -05002288/*
2289 * NOTE: This must be executed from our workqueue as it results in udelay
2290 * being called which may corrupt the keyboard if executed on default
2291 * workqueue
2292 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002293static void ipw_adapter_restart(void *adapter)
2294{
2295 struct ipw_priv *priv = adapter;
2296
2297 if (priv->status & STATUS_RF_KILL_MASK)
2298 return;
2299
2300 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002301
2302 if (priv->assoc_network &&
2303 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2304 ipw_remove_current_network(priv);
2305
James Ketrenos43f66a62005-03-25 12:31:53 -06002306 if (ipw_up(priv)) {
2307 IPW_ERROR("Failed to up device\n");
2308 return;
2309 }
2310}
2311
David Howellsc4028952006-11-22 14:57:56 +00002312static void ipw_bg_adapter_restart(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002313{
David Howellsc4028952006-11-22 14:57:56 +00002314 struct ipw_priv *priv =
2315 container_of(work, struct ipw_priv, adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08002316 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002317 ipw_adapter_restart(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002318 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002319}
2320
James Ketrenos43f66a62005-03-25 12:31:53 -06002321#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2322
2323static void ipw_scan_check(void *data)
2324{
2325 struct ipw_priv *priv = data;
2326 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2327 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002328 "adapter after (%dms).\n",
2329 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002330 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002331 }
2332}
2333
David Howellsc4028952006-11-22 14:57:56 +00002334static void ipw_bg_scan_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002335{
David Howellsc4028952006-11-22 14:57:56 +00002336 struct ipw_priv *priv =
2337 container_of(work, struct ipw_priv, scan_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08002338 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002339 ipw_scan_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002340 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002341}
2342
James Ketrenos43f66a62005-03-25 12:31:53 -06002343static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2344 struct ipw_scan_request_ext *request)
2345{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002346 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002347 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002348}
2349
2350static int ipw_send_scan_abort(struct ipw_priv *priv)
2351{
James Ketrenos43f66a62005-03-25 12:31:53 -06002352 if (!priv) {
2353 IPW_ERROR("Invalid args\n");
2354 return -1;
2355 }
2356
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002357 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002358}
2359
2360static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2361{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002362 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002363 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002364 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002365
2366 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002367 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002368}
2369
2370static int ipw_send_associate(struct ipw_priv *priv,
2371 struct ipw_associate *associate)
2372{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002373 if (!priv || !associate) {
2374 IPW_ERROR("Invalid args\n");
2375 return -1;
2376 }
2377
Al Viro5b5e8072007-12-27 01:54:06 -05002378 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(*associate),
2379 associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002380}
2381
2382static int ipw_send_supported_rates(struct ipw_priv *priv,
2383 struct ipw_supported_rates *rates)
2384{
James Ketrenos43f66a62005-03-25 12:31:53 -06002385 if (!priv || !rates) {
2386 IPW_ERROR("Invalid args\n");
2387 return -1;
2388 }
2389
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002390 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002391 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002392}
2393
2394static int ipw_set_random_seed(struct ipw_priv *priv)
2395{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002396 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002397
2398 if (!priv) {
2399 IPW_ERROR("Invalid args\n");
2400 return -1;
2401 }
2402
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002403 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002404
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002405 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002406}
2407
James Ketrenos43f66a62005-03-25 12:31:53 -06002408static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2409{
Al Viroe62e1ee2007-12-27 01:36:46 -05002410 __le32 v = cpu_to_le32(phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002411 if (!priv) {
2412 IPW_ERROR("Invalid args\n");
2413 return -1;
2414 }
2415
Al Viroe62e1ee2007-12-27 01:36:46 -05002416 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(v), &v);
James Ketrenos43f66a62005-03-25 12:31:53 -06002417}
James Ketrenos43f66a62005-03-25 12:31:53 -06002418
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002419static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002420{
James Ketrenos43f66a62005-03-25 12:31:53 -06002421 if (!priv || !power) {
2422 IPW_ERROR("Invalid args\n");
2423 return -1;
2424 }
2425
Zhu Yi2638bc32006-01-24 16:37:52 +08002426 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002427}
James Ketrenos43f66a62005-03-25 12:31:53 -06002428
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002429static int ipw_set_tx_power(struct ipw_priv *priv)
2430{
Larry Finger1867b112006-02-28 09:48:28 -06002431 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002432 struct ipw_tx_power tx_power;
2433 s8 max_power;
2434 int i;
2435
2436 memset(&tx_power, 0, sizeof(tx_power));
2437
2438 /* configure device for 'G' band */
2439 tx_power.ieee_mode = IPW_G_MODE;
2440 tx_power.num_channels = geo->bg_channels;
2441 for (i = 0; i < geo->bg_channels; i++) {
2442 max_power = geo->bg[i].max_power;
2443 tx_power.channels_tx_power[i].channel_number =
2444 geo->bg[i].channel;
2445 tx_power.channels_tx_power[i].tx_power = max_power ?
2446 min(max_power, priv->tx_power) : priv->tx_power;
2447 }
2448 if (ipw_send_tx_power(priv, &tx_power))
2449 return -EIO;
2450
2451 /* configure device to also handle 'B' band */
2452 tx_power.ieee_mode = IPW_B_MODE;
2453 if (ipw_send_tx_power(priv, &tx_power))
2454 return -EIO;
2455
2456 /* configure device to also handle 'A' band */
2457 if (priv->ieee->abg_true) {
2458 tx_power.ieee_mode = IPW_A_MODE;
2459 tx_power.num_channels = geo->a_channels;
2460 for (i = 0; i < tx_power.num_channels; i++) {
2461 max_power = geo->a[i].max_power;
2462 tx_power.channels_tx_power[i].channel_number =
2463 geo->a[i].channel;
2464 tx_power.channels_tx_power[i].tx_power = max_power ?
2465 min(max_power, priv->tx_power) : priv->tx_power;
2466 }
2467 if (ipw_send_tx_power(priv, &tx_power))
2468 return -EIO;
2469 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002470 return 0;
2471}
2472
2473static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2474{
2475 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002476 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002477 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002478
2479 if (!priv) {
2480 IPW_ERROR("Invalid args\n");
2481 return -1;
2482 }
2483
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002484 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2485 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002486}
2487
2488static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2489{
2490 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002491 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002492 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002493
2494 if (!priv) {
2495 IPW_ERROR("Invalid args\n");
2496 return -1;
2497 }
2498
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002499 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2500 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002501}
2502
2503static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2504{
Al Viroe62e1ee2007-12-27 01:36:46 -05002505 __le32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002506
2507 if (!priv) {
2508 IPW_ERROR("Invalid args\n");
2509 return -1;
2510 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002511
James Ketrenos43f66a62005-03-25 12:31:53 -06002512 /* If on battery, set to 3, if AC set to CAM, else user
2513 * level */
2514 switch (mode) {
2515 case IPW_POWER_BATTERY:
Al Viroe62e1ee2007-12-27 01:36:46 -05002516 param = cpu_to_le32(IPW_POWER_INDEX_3);
James Ketrenos43f66a62005-03-25 12:31:53 -06002517 break;
2518 case IPW_POWER_AC:
Al Viroe62e1ee2007-12-27 01:36:46 -05002519 param = cpu_to_le32(IPW_POWER_MODE_CAM);
James Ketrenos43f66a62005-03-25 12:31:53 -06002520 break;
2521 default:
Al Viroe62e1ee2007-12-27 01:36:46 -05002522 param = cpu_to_le32(mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06002523 break;
2524 }
2525
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002526 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002527 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002528}
2529
James Ketrenosafbf30a2005-08-25 00:05:33 -05002530static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2531{
2532 struct ipw_retry_limit retry_limit = {
2533 .short_retry_limit = slimit,
2534 .long_retry_limit = llimit
2535 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002536
2537 if (!priv) {
2538 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002539 return -1;
2540 }
2541
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002542 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002543 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002544}
2545
2546/*
2547 * The IPW device contains a Microwire compatible EEPROM that stores
2548 * various data like the MAC address. Usually the firmware has exclusive
2549 * access to the eeprom, but during device initialization (before the
2550 * device driver has sent the HostComplete command to the firmware) the
2551 * device driver has read access to the EEPROM by way of indirect addressing
2552 * through a couple of memory mapped registers.
2553 *
2554 * The following is a simplified implementation for pulling data out of the
2555 * the eeprom, along with some helper functions to find information in
2556 * the per device private data's copy of the eeprom.
2557 *
2558 * NOTE: To better understand how these functions work (i.e what is a chip
2559 * select and why do have to keep driving the eeprom clock?), read
2560 * just about any data sheet for a Microwire compatible EEPROM.
2561 */
2562
2563/* write a 32 bit value into the indirect accessor register */
2564static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2565{
2566 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002567
James Ketrenos43f66a62005-03-25 12:31:53 -06002568 /* the eeprom requires some time to complete the operation */
2569 udelay(p->eeprom_delay);
2570
2571 return;
2572}
2573
2574/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002575static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002576{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002577 eeprom_write_reg(priv, 0);
2578 eeprom_write_reg(priv, EEPROM_BIT_CS);
2579 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2580 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002581}
2582
2583/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002584static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002585{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002586 eeprom_write_reg(priv, EEPROM_BIT_CS);
2587 eeprom_write_reg(priv, 0);
2588 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002589}
2590
2591/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002592static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002593{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002594 int d = (bit ? EEPROM_BIT_DI : 0);
2595 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2596 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002597}
2598
2599/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002600static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002601{
2602 int i;
2603
2604 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002605 eeprom_write_bit(priv, 1);
2606 eeprom_write_bit(priv, op & 2);
2607 eeprom_write_bit(priv, op & 1);
2608 for (i = 7; i >= 0; i--) {
2609 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002610 }
2611}
2612
2613/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002614static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002615{
2616 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002617 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002618
James Ketrenos43f66a62005-03-25 12:31:53 -06002619 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002620 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002621
2622 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002623 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002624
2625 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002626 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002627 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002628 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2629 eeprom_write_reg(priv, EEPROM_BIT_CS);
2630 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2631 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002632 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002633
James Ketrenos43f66a62005-03-25 12:31:53 -06002634 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002635 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002636 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002637
James Ketrenos43f66a62005-03-25 12:31:53 -06002638 return r;
2639}
2640
2641/* helper function for pulling the mac address out of the private */
2642/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002643static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002644{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002645 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002646}
2647
2648/*
2649 * Either the device driver (i.e. the host) or the firmware can
2650 * load eeprom data into the designated region in SRAM. If neither
2651 * happens then the FW will shutdown with a fatal error.
2652 *
2653 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2654 * bit needs region of shared SRAM needs to be non-zero.
2655 */
2656static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2657{
2658 int i;
Al Viroe62e1ee2007-12-27 01:36:46 -05002659 __le16 *eeprom = (__le16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002660
James Ketrenos43f66a62005-03-25 12:31:53 -06002661 IPW_DEBUG_TRACE(">>\n");
2662
2663 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002664 for (i = 0; i < 128; i++)
Al Viroe62e1ee2007-12-27 01:36:46 -05002665 eeprom[i] = cpu_to_le16(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002666
Jeff Garzikbf794512005-07-31 13:07:26 -04002667 /*
2668 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002669 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002670 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002671 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002672 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002673 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2674
2675 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002676 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002677 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002678
2679 /* Do not load eeprom data on fatal error or suspend */
2680 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2681 } else {
2682 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2683
2684 /* Load eeprom data on fatal error or suspend */
2685 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2686 }
2687
2688 IPW_DEBUG_TRACE("<<\n");
2689}
2690
Arjan van de Ven858119e2006-01-14 13:20:43 -08002691static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002692{
2693 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002694 if (!count)
2695 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002696 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002697 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002698 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002699}
2700
2701static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2702{
James Ketrenosb095c382005-08-24 22:04:42 -05002703 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002704 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002705 sizeof(struct command_block));
2706}
2707
2708static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002709{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002710
2711 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002712
James Ketrenos43f66a62005-03-25 12:31:53 -06002713 /* Start the dma */
2714 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002715
James Ketrenos43f66a62005-03-25 12:31:53 -06002716 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002717 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002718
2719 IPW_DEBUG_FW("<< : \n");
2720 return 0;
2721}
2722
2723static void ipw_fw_dma_abort(struct ipw_priv *priv)
2724{
2725 u32 control = 0;
2726
2727 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002728
Pavel Machek67fd6b42006-07-11 15:34:05 +02002729 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002730 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002731 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002732 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002733
James Ketrenos43f66a62005-03-25 12:31:53 -06002734 IPW_DEBUG_FW("<< \n");
2735}
2736
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002737static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2738 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002739{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002740 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002741 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002742 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002743 IPW_DEBUG_FW(">> :\n");
2744
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002745 ipw_write_indirect(priv, address, (u8 *) cb,
2746 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002747
2748 IPW_DEBUG_FW("<< :\n");
2749 return 0;
2750
2751}
2752
2753static int ipw_fw_dma_kick(struct ipw_priv *priv)
2754{
2755 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002756 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002757
2758 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002759
James Ketrenos43f66a62005-03-25 12:31:53 -06002760 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002761 ipw_fw_dma_write_command_block(priv, index,
2762 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002763
2764 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002765 ipw_clear_bit(priv, IPW_RESET_REG,
2766 IPW_RESET_REG_MASTER_DISABLED |
2767 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002768
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002769 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002770 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002771 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002772
2773 IPW_DEBUG_FW("<< :\n");
2774 return 0;
2775}
2776
2777static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2778{
2779 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002780 u32 register_value = 0;
2781 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002782
2783 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002784 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002785 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002786
2787 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002788 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2789 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002790
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002791 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002792 cb_fields_address = address;
2793 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002794 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002795
2796 cb_fields_address += sizeof(u32);
2797 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002798 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002799
2800 cb_fields_address += sizeof(u32);
2801 register_value = ipw_read_reg32(priv, cb_fields_address);
2802 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2803 register_value);
2804
2805 cb_fields_address += sizeof(u32);
2806 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002807 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002808
2809 IPW_DEBUG_FW(">> :\n");
2810}
2811
2812static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2813{
2814 u32 current_cb_address = 0;
2815 u32 current_cb_index = 0;
2816
2817 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002818 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002819
James Ketrenosb095c382005-08-24 22:04:42 -05002820 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002821 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002822
James Ketrenos43f66a62005-03-25 12:31:53 -06002823 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002824 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002825
2826 IPW_DEBUG_FW(">> :\n");
2827 return current_cb_index;
2828
2829}
2830
2831static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2832 u32 src_address,
2833 u32 dest_address,
2834 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002835 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002836{
2837
Jeff Garzikbf794512005-07-31 13:07:26 -04002838 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002839 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2840 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002841 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002842 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002843
2844 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2845 src_address, dest_address, length);
2846
2847 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2848 return -1;
2849
2850 last_cb_element = priv->sram_desc.last_cb_index;
2851 cb = &priv->sram_desc.cb_list[last_cb_element];
2852 priv->sram_desc.last_cb_index++;
2853
2854 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002855 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002856 control |= CB_INT_ENABLED;
2857
2858 if (is_last)
2859 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002860
James Ketrenos43f66a62005-03-25 12:31:53 -06002861 control |= length;
2862
2863 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002864 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002865
2866 /* Copy the Source and Destination addresses */
2867 cb->dest_addr = dest_address;
2868 cb->source_addr = src_address;
2869
2870 /* Copy the Control Word last */
2871 cb->control = control;
2872
2873 return 0;
2874}
2875
2876static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002877 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002878{
2879 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002880 u32 src_offset = 0;
2881 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002882 int status = 0;
2883 IPW_DEBUG_FW(">> \n");
2884 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2885 src_phys, dest_address, length);
2886 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002887 status = ipw_fw_dma_add_command_block(priv,
2888 src_phys + src_offset,
2889 dest_address +
2890 dest_offset,
2891 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002892 if (status) {
2893 IPW_DEBUG_FW_INFO(": Failed\n");
2894 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002895 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002896 IPW_DEBUG_FW_INFO(": Added new cb\n");
2897
2898 src_offset += CB_MAX_LENGTH;
2899 dest_offset += CB_MAX_LENGTH;
2900 bytes_left -= CB_MAX_LENGTH;
2901 }
2902
2903 /* add the buffer tail */
2904 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002905 status =
2906 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2907 dest_address + dest_offset,
2908 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002909 if (status) {
2910 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2911 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002912 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002913 IPW_DEBUG_FW_INFO
2914 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002915 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002916
James Ketrenos43f66a62005-03-25 12:31:53 -06002917 IPW_DEBUG_FW("<< \n");
2918 return 0;
2919}
2920
2921static int ipw_fw_dma_wait(struct ipw_priv *priv)
2922{
Zhu Yi397ae122006-01-24 16:37:22 +08002923 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002924 u32 watchdog = 0;
2925
2926 IPW_DEBUG_FW(">> : \n");
2927
2928 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002929 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002930 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002931
2932 while (current_index < priv->sram_desc.last_cb_index) {
2933 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002934 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002935 current_index = ipw_fw_dma_command_block_index(priv);
2936
Zhu Yi397ae122006-01-24 16:37:22 +08002937 if (previous_index < current_index) {
2938 watchdog = 0;
2939 continue;
2940 }
2941 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002942 IPW_DEBUG_FW_INFO("Timeout\n");
2943 ipw_fw_dma_dump_command_block(priv);
2944 ipw_fw_dma_abort(priv);
2945 return -1;
2946 }
2947 }
2948
2949 ipw_fw_dma_abort(priv);
2950
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002951 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002952 ipw_set_bit(priv, IPW_RESET_REG,
2953 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002954
2955 IPW_DEBUG_FW("<< dmaWaitSync \n");
2956 return 0;
2957}
2958
Jeff Garzikbf794512005-07-31 13:07:26 -04002959static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002960{
2961 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002962 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002963 unsigned long flags;
2964
2965 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002966 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2967 network = list_entry(element, struct ieee80211_network, list);
2968 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2969 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002970 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002971 &priv->ieee->network_free_list);
2972 }
2973 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002974 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002975}
2976
2977/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002978 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002979 * Reads debug register from domain0.
2980 * If card is present, pre-defined value should
2981 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002982 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002983 * @param priv
2984 * @return 1 if card is present, 0 otherwise
2985 */
2986static inline int ipw_alive(struct ipw_priv *priv)
2987{
2988 return ipw_read32(priv, 0x90) == 0xd55555d5;
2989}
2990
Zhu Yic7b6a672006-01-24 16:37:05 +08002991/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002992static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002993 int timeout)
2994{
2995 int i = 0;
2996
2997 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002998 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002999 return i;
3000 mdelay(10);
3001 i += 10;
3002 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04003003
James Ketrenos43f66a62005-03-25 12:31:53 -06003004 return -ETIME;
3005}
3006
Jeff Garzikbf794512005-07-31 13:07:26 -04003007/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06003008 * the ipw hardware. It assumes the buffer has all the bits for the
3009 * image and the caller is handling the memory allocation and clean up.
3010 */
3011
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003012static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06003013{
3014 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003015
James Ketrenos43f66a62005-03-25 12:31:53 -06003016 IPW_DEBUG_TRACE(">> \n");
3017 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05003018 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003019
Zhu Yic7b6a672006-01-24 16:37:05 +08003020 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05003021 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3022 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06003023 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003024 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003025 return -1;
3026 }
3027
3028 IPW_DEBUG_INFO("stop master %dms\n", rc);
3029
3030 return rc;
3031}
3032
3033static void ipw_arc_release(struct ipw_priv *priv)
3034{
3035 IPW_DEBUG_TRACE(">> \n");
3036 mdelay(5);
3037
James Ketrenosb095c382005-08-24 22:04:42 -05003038 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003039
3040 /* no one knows timing, for safety add some delay */
3041 mdelay(5);
3042}
3043
James Ketrenos43f66a62005-03-25 12:31:53 -06003044struct fw_chunk {
Al Viroe62e1ee2007-12-27 01:36:46 -05003045 __le32 address;
3046 __le32 length;
James Ketrenos43f66a62005-03-25 12:31:53 -06003047};
3048
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003049static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003050{
3051 int rc = 0, i, addr;
3052 u8 cr = 0;
Al Viroe62e1ee2007-12-27 01:36:46 -05003053 __le16 *image;
James Ketrenos43f66a62005-03-25 12:31:53 -06003054
Al Viroe62e1ee2007-12-27 01:36:46 -05003055 image = (__le16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04003056
James Ketrenos43f66a62005-03-25 12:31:53 -06003057 IPW_DEBUG_TRACE(">> \n");
3058
3059 rc = ipw_stop_master(priv);
3060
3061 if (rc < 0)
3062 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003063
James Ketrenosb095c382005-08-24 22:04:42 -05003064 for (addr = IPW_SHARED_LOWER_BOUND;
3065 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003066 ipw_write32(priv, addr, 0);
3067 }
3068
3069 /* no ucode (yet) */
3070 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3071 /* destroy DMA queues */
3072 /* reset sequence */
3073
James Ketrenosb095c382005-08-24 22:04:42 -05003074 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003075 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003076 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003077 mdelay(1);
3078
3079 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003080 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003081 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003082
James Ketrenosb095c382005-08-24 22:04:42 -05003083 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003084 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003085
James Ketrenos43f66a62005-03-25 12:31:53 -06003086 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003087 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3088 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003089 mdelay(1);
3090
3091 /* write ucode */
3092 /**
3093 * @bug
3094 * Do NOT set indirect address register once and then
3095 * store data to indirect data register in the loop.
3096 * It seems very reasonable, but in this case DINO do not
3097 * accept ucode. It is essential to set address each time.
3098 */
3099 /* load new ipw uCode */
3100 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003101 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
Al Viroe62e1ee2007-12-27 01:36:46 -05003102 le16_to_cpu(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003103
James Ketrenos43f66a62005-03-25 12:31:53 -06003104 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003105 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3106 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003107
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003108 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003109
3110 /* wait for alive response */
3111 for (i = 0; i < 100; i++) {
3112 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003113 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003114 if (cr & DINO_RXFIFO_DATA)
3115 break;
3116 mdelay(1);
3117 }
3118
3119 if (cr & DINO_RXFIFO_DATA) {
3120 /* alive_command_responce size is NOT multiple of 4 */
Al Viroe62e1ee2007-12-27 01:36:46 -05003121 __le32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003122
3123 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003124 response_buffer[i] =
Al Viroe62e1ee2007-12-27 01:36:46 -05003125 cpu_to_le32(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003126 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003127 memcpy(&priv->dino_alive, response_buffer,
3128 sizeof(priv->dino_alive));
3129 if (priv->dino_alive.alive_command == 1
3130 && priv->dino_alive.ucode_valid == 1) {
3131 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003132 IPW_DEBUG_INFO
3133 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3134 "of %02d/%02d/%02d %02d:%02d\n",
3135 priv->dino_alive.software_revision,
3136 priv->dino_alive.software_revision,
3137 priv->dino_alive.device_identifier,
3138 priv->dino_alive.device_identifier,
3139 priv->dino_alive.time_stamp[0],
3140 priv->dino_alive.time_stamp[1],
3141 priv->dino_alive.time_stamp[2],
3142 priv->dino_alive.time_stamp[3],
3143 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003144 } else {
3145 IPW_DEBUG_INFO("Microcode is not alive\n");
3146 rc = -EINVAL;
3147 }
3148 } else {
3149 IPW_DEBUG_INFO("No alive response from DINO\n");
3150 rc = -ETIME;
3151 }
3152
3153 /* disable DINO, otherwise for some reason
3154 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003155 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003156
James Ketrenos43f66a62005-03-25 12:31:53 -06003157 return rc;
3158}
3159
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003160static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003161{
3162 int rc = -1;
3163 int offset = 0;
3164 struct fw_chunk *chunk;
3165 dma_addr_t shared_phys;
3166 u8 *shared_virt;
3167
3168 IPW_DEBUG_TRACE("<< : \n");
3169 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3170
3171 if (!shared_virt)
3172 return -ENOMEM;
3173
3174 memmove(shared_virt, data, len);
3175
3176 /* Start the Dma */
3177 rc = ipw_fw_dma_enable(priv);
3178
3179 if (priv->sram_desc.last_cb_index > 0) {
3180 /* the DMA is already ready this would be a bug. */
3181 BUG();
3182 goto out;
3183 }
3184
3185 do {
3186 chunk = (struct fw_chunk *)(data + offset);
3187 offset += sizeof(struct fw_chunk);
3188 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003189 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003190 * offeset*/
3191 /* Dma loading */
3192 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003193 le32_to_cpu(chunk->address),
3194 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003195 if (rc) {
3196 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3197 goto out;
3198 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003199
James Ketrenosa613bff2005-08-24 21:43:11 -05003200 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003201 } while (offset < len);
3202
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003203 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003204 rc = ipw_fw_dma_kick(priv);
3205 if (rc) {
3206 IPW_ERROR("dmaKick Failed\n");
3207 goto out;
3208 }
3209
3210 rc = ipw_fw_dma_wait(priv);
3211 if (rc) {
3212 IPW_ERROR("dmaWaitSync Failed\n");
3213 goto out;
3214 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003215 out:
3216 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003217 return rc;
3218}
3219
3220/* stop nic */
3221static int ipw_stop_nic(struct ipw_priv *priv)
3222{
3223 int rc = 0;
3224
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003225 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003226 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003227
James Ketrenosb095c382005-08-24 22:04:42 -05003228 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3229 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003230 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003231 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003232 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003233 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003234
James Ketrenosb095c382005-08-24 22:04:42 -05003235 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003236
James Ketrenos43f66a62005-03-25 12:31:53 -06003237 return rc;
3238}
3239
3240static void ipw_start_nic(struct ipw_priv *priv)
3241{
3242 IPW_DEBUG_TRACE(">>\n");
3243
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003244 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003245 ipw_clear_bit(priv, IPW_RESET_REG,
3246 IPW_RESET_REG_MASTER_DISABLED |
3247 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003248 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003249
James Ketrenos43f66a62005-03-25 12:31:53 -06003250 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003251 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3252 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003253
3254 IPW_DEBUG_TRACE("<<\n");
3255}
Jeff Garzikbf794512005-07-31 13:07:26 -04003256
James Ketrenos43f66a62005-03-25 12:31:53 -06003257static int ipw_init_nic(struct ipw_priv *priv)
3258{
3259 int rc;
3260
3261 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003262 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003263 /*prvHwInitNic */
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 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003268 ipw_write32(priv, IPW_READ_INT_REGISTER,
3269 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003270
3271 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003272 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3273 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003274 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003275 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3276
3277 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003278 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003279
3280 udelay(10);
3281
3282 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003283 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003284
3285 IPW_DEBUG_TRACE(">>\n");
3286 return 0;
3287}
3288
Jeff Garzikbf794512005-07-31 13:07:26 -04003289/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003290 * Probe is an ok place to call this from.
3291 */
3292static int ipw_reset_nic(struct ipw_priv *priv)
3293{
3294 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003295 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003296
3297 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003298
James Ketrenos43f66a62005-03-25 12:31:53 -06003299 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003300
James Ketrenosa613bff2005-08-24 21:43:11 -05003301 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003302 /* Clear the 'host command active' bit... */
3303 priv->status &= ~STATUS_HCMD_ACTIVE;
3304 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003305 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3306 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003307 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003308
3309 IPW_DEBUG_TRACE("<<\n");
3310 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003311}
James Ketrenos43f66a62005-03-25 12:31:53 -06003312
James Ketrenos9006ea72006-03-08 03:22:28 +08003313
3314struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003315 __le32 ver;
3316 __le32 boot_size;
3317 __le32 ucode_size;
3318 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003319 u8 data[0];
3320};
3321
Jeff Garzikbf794512005-07-31 13:07:26 -04003322static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003323 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003324{
James Ketrenos9006ea72006-03-08 03:22:28 +08003325 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003326 int rc;
3327
3328 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003329 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003330 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003331 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003332 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003333 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003334
James Ketrenos9006ea72006-03-08 03:22:28 +08003335 if ((*raw)->size < sizeof(*fw)) {
3336 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003337 return -EINVAL;
3338 }
3339
James Ketrenos9006ea72006-03-08 03:22:28 +08003340 fw = (void *)(*raw)->data;
3341
Zhu Yi0070f8c2006-04-13 17:20:12 +08003342 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3343 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003344 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3345 name, (*raw)->size);
3346 return -EINVAL;
3347 }
3348
3349 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003350 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003351 le32_to_cpu(fw->ver) >> 16,
3352 le32_to_cpu(fw->ver) & 0xff,
3353 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003354 return 0;
3355}
3356
James Ketrenosb095c382005-08-24 22:04:42 -05003357#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003358
Arjan van de Ven858119e2006-01-14 13:20:43 -08003359static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003360 struct ipw_rx_queue *rxq)
3361{
3362 unsigned long flags;
3363 int i;
3364
3365 spin_lock_irqsave(&rxq->lock, flags);
3366
3367 INIT_LIST_HEAD(&rxq->rx_free);
3368 INIT_LIST_HEAD(&rxq->rx_used);
3369
3370 /* Fill the rx_used queue with _all_ of the Rx buffers */
3371 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3372 /* In the reset function, these buffers may have been allocated
3373 * to an SKB, so we need to unmap and free potential storage */
3374 if (rxq->pool[i].skb != NULL) {
3375 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003376 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003377 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003378 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003379 }
3380 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3381 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003382
James Ketrenos43f66a62005-03-25 12:31:53 -06003383 /* Set us so that we have processed and used all buffers, but have
3384 * not restocked the Rx queue with fresh buffers */
3385 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003386 rxq->free_count = 0;
3387 spin_unlock_irqrestore(&rxq->lock, flags);
3388}
3389
3390#ifdef CONFIG_PM
3391static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003392static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003393
3394static void free_firmware(void)
3395{
3396 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003397 release_firmware(raw);
3398 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003399 fw_loaded = 0;
3400 }
3401}
3402#else
3403#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003404#endif
3405
3406static int ipw_load(struct ipw_priv *priv)
3407{
3408#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003409 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003410#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003411 struct ipw_fw *fw;
3412 u8 *boot_img, *ucode_img, *fw_img;
3413 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003414 int rc = 0, retries = 3;
3415
Zhu Yi397ae122006-01-24 16:37:22 +08003416 switch (priv->ieee->iw_mode) {
3417 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003418 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003419 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003420#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003421 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003422 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003423 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003424#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003425 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003426 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003427 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003428 }
Zhu Yi397ae122006-01-24 16:37:22 +08003429
James Ketrenos9006ea72006-03-08 03:22:28 +08003430 if (!name) {
3431 rc = -EINVAL;
3432 goto error;
3433 }
3434
3435#ifdef CONFIG_PM
3436 if (!fw_loaded) {
3437#endif
3438 rc = ipw_get_fw(priv, &raw, name);
3439 if (rc < 0)
3440 goto error;
3441#ifdef CONFIG_PM
3442 }
3443#endif
3444
3445 fw = (void *)raw->data;
3446 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003447 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3448 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3449 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003450
Zhu Yi397ae122006-01-24 16:37:22 +08003451 if (rc < 0)
3452 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003453
3454 if (!priv->rxq)
3455 priv->rxq = ipw_rx_queue_alloc(priv);
3456 else
3457 ipw_rx_queue_reset(priv, priv->rxq);
3458 if (!priv->rxq) {
3459 IPW_ERROR("Unable to initialize Rx queue\n");
3460 goto error;
3461 }
3462
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003463 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003464 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003465 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003466 priv->status &= ~STATUS_INT_ENABLED;
3467
3468 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003469 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003470
James Ketrenos43f66a62005-03-25 12:31:53 -06003471 ipw_stop_nic(priv);
3472
3473 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003474 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003475 IPW_ERROR("Unable to reset NIC\n");
3476 goto error;
3477 }
3478
James Ketrenosb095c382005-08-24 22:04:42 -05003479 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3480 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003481
3482 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003483 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003484 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003485 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003486 goto error;
3487 }
3488
3489 /* kick start the device */
3490 ipw_start_nic(priv);
3491
Zhu Yic7b6a672006-01-24 16:37:05 +08003492 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003493 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3494 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003495 if (rc < 0) {
3496 IPW_ERROR("device failed to boot initial fw image\n");
3497 goto error;
3498 }
3499 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3500
Jeff Garzikbf794512005-07-31 13:07:26 -04003501 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003502 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003503
3504 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003505 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003506 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003507 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003508 goto error;
3509 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003510
James Ketrenos43f66a62005-03-25 12:31:53 -06003511 /* stop nic */
3512 ipw_stop_nic(priv);
3513
3514 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003515 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003516 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003517 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003518 goto error;
3519 }
Zhu Yi397ae122006-01-24 16:37:22 +08003520#ifdef CONFIG_PM
3521 fw_loaded = 1;
3522#endif
3523
James Ketrenos43f66a62005-03-25 12:31:53 -06003524 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3525
3526 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003527 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003528 IPW_ERROR("Unable to initialize queues\n");
3529 goto error;
3530 }
3531
3532 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003533 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003534 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003535 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003536
James Ketrenos43f66a62005-03-25 12:31:53 -06003537 /* kick start the device */
3538 ipw_start_nic(priv);
3539
James Ketrenosb095c382005-08-24 22:04:42 -05003540 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003541 if (retries > 0) {
3542 IPW_WARNING("Parity error. Retrying init.\n");
3543 retries--;
3544 goto retry;
3545 }
3546
3547 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3548 rc = -EIO;
3549 goto error;
3550 }
3551
3552 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003553 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3554 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003555 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003556 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003557 goto error;
3558 }
3559 IPW_DEBUG_INFO("device response after %dms\n", rc);
3560
3561 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003562 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003563
3564 /* read eeprom data and initialize the eeprom region of sram */
3565 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003566 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003567
3568 /* enable interrupts */
3569 ipw_enable_interrupts(priv);
3570
3571 /* Ensure our queue has valid packets */
3572 ipw_rx_queue_replenish(priv);
3573
James Ketrenosb095c382005-08-24 22:04:42 -05003574 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003575
3576 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003577 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003578
3579#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003580 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003581#endif
3582 return 0;
3583
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003584 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003585 if (priv->rxq) {
3586 ipw_rx_queue_free(priv, priv->rxq);
3587 priv->rxq = NULL;
3588 }
3589 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003590 if (raw)
3591 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003592#ifdef CONFIG_PM
3593 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003594 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003595#endif
3596
3597 return rc;
3598}
3599
Jeff Garzikbf794512005-07-31 13:07:26 -04003600/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003601 * DMA services
3602 *
3603 * Theory of operation
3604 *
3605 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3606 * 2 empty entries always kept in the buffer to protect from overflow.
3607 *
3608 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003609 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3610 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003611 * Tx queue resumed.
3612 *
3613 * The IPW operates with six queues, one receive queue in the device's
3614 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003615 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003616 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003617 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003618 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003619 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003620 * we only utilize the first data transmit queue (queue1).
3621 */
3622
3623/**
3624 * Driver allocates buffers of this size for Rx
3625 */
3626
Dan Williams943dbef2008-02-14 17:49:41 -05003627/**
3628 * ipw_rx_queue_space - Return number of free slots available in queue.
3629 */
3630static int ipw_rx_queue_space(const struct ipw_rx_queue *q)
3631{
3632 int s = q->read - q->write;
3633 if (s <= 0)
3634 s += RX_QUEUE_SIZE;
3635 /* keep some buffer to not confuse full and empty queue */
3636 s -= 2;
3637 if (s < 0)
3638 s = 0;
3639 return s;
3640}
3641
3642static inline int ipw_tx_queue_space(const struct clx2_queue *q)
James Ketrenos43f66a62005-03-25 12:31:53 -06003643{
3644 int s = q->last_used - q->first_empty;
3645 if (s <= 0)
3646 s += q->n_bd;
3647 s -= 2; /* keep some reserve to not confuse empty and full situations */
3648 if (s < 0)
3649 s = 0;
3650 return s;
3651}
3652
3653static inline int ipw_queue_inc_wrap(int index, int n_bd)
3654{
3655 return (++index == n_bd) ? 0 : index;
3656}
3657
3658/**
3659 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003660 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003661 * @param q queue to init
3662 * @param count Number of BD's to allocate. Should be power of 2
3663 * @param read_register Address for 'read' register
3664 * (not offset within BAR, full address)
3665 * @param write_register Address for 'write' register
3666 * (not offset within BAR, full address)
3667 * @param base_register Address for 'base' register
3668 * (not offset within BAR, full address)
3669 * @param size Address for 'size' register
3670 * (not offset within BAR, full address)
3671 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003672static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003673 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003674{
3675 q->n_bd = count;
3676
3677 q->low_mark = q->n_bd / 4;
3678 if (q->low_mark < 4)
3679 q->low_mark = 4;
3680
3681 q->high_mark = q->n_bd / 8;
3682 if (q->high_mark < 2)
3683 q->high_mark = 2;
3684
3685 q->first_empty = q->last_used = 0;
3686 q->reg_r = read;
3687 q->reg_w = write;
3688
3689 ipw_write32(priv, base, q->dma_addr);
3690 ipw_write32(priv, size, count);
3691 ipw_write32(priv, read, 0);
3692 ipw_write32(priv, write, 0);
3693
3694 _ipw_read32(priv, 0x90);
3695}
3696
Jeff Garzikbf794512005-07-31 13:07:26 -04003697static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003698 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003699 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003700{
3701 struct pci_dev *dev = priv->pci_dev;
3702
3703 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3704 if (!q->txb) {
3705 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3706 return -ENOMEM;
3707 }
3708
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003709 q->bd =
3710 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003711 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003712 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003713 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003714 kfree(q->txb);
3715 q->txb = NULL;
3716 return -ENOMEM;
3717 }
3718
3719 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3720 return 0;
3721}
3722
3723/**
3724 * Free one TFD, those at index [txq->q.last_used].
3725 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003726 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003727 * @param dev
3728 * @param txq
3729 */
3730static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3731 struct clx2_tx_queue *txq)
3732{
3733 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3734 struct pci_dev *dev = priv->pci_dev;
3735 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003736
James Ketrenos43f66a62005-03-25 12:31:53 -06003737 /* classify bd */
3738 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3739 /* nothing to cleanup after for host commands */
3740 return;
3741
3742 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003743 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3744 IPW_ERROR("Too many chunks: %i\n",
3745 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003746 /** @todo issue fatal error, it is quite serious situation */
3747 return;
3748 }
3749
3750 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003751 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3752 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3753 le16_to_cpu(bd->u.data.chunk_len[i]),
3754 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003755 if (txq->txb[txq->q.last_used]) {
3756 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3757 txq->txb[txq->q.last_used] = NULL;
3758 }
3759 }
3760}
3761
3762/**
3763 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003764 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003765 * Empty queue by removing and destroying all BD's.
3766 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003767 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003768 * @param dev
3769 * @param q
3770 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003771static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003772{
3773 struct clx2_queue *q = &txq->q;
3774 struct pci_dev *dev = priv->pci_dev;
3775
Jeff Garzikbf794512005-07-31 13:07:26 -04003776 if (q->n_bd == 0)
3777 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003778
3779 /* first, empty all BD's */
3780 for (; q->first_empty != q->last_used;
3781 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3782 ipw_queue_tx_free_tfd(priv, txq);
3783 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003784
James Ketrenos43f66a62005-03-25 12:31:53 -06003785 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003786 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003787 q->dma_addr);
3788 kfree(txq->txb);
3789
3790 /* 0 fill whole structure */
3791 memset(txq, 0, sizeof(*txq));
3792}
3793
James Ketrenos43f66a62005-03-25 12:31:53 -06003794/**
3795 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003796 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003797 * @param priv
3798 */
3799static void ipw_tx_queue_free(struct ipw_priv *priv)
3800{
3801 /* Tx CMD queue */
3802 ipw_queue_tx_free(priv, &priv->txq_cmd);
3803
3804 /* Tx queues */
3805 ipw_queue_tx_free(priv, &priv->txq[0]);
3806 ipw_queue_tx_free(priv, &priv->txq[1]);
3807 ipw_queue_tx_free(priv, &priv->txq[2]);
3808 ipw_queue_tx_free(priv, &priv->txq[3]);
3809}
3810
Arjan van de Ven858119e2006-01-14 13:20:43 -08003811static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003812{
3813 /* First 3 bytes are manufacturer */
3814 bssid[0] = priv->mac_addr[0];
3815 bssid[1] = priv->mac_addr[1];
3816 bssid[2] = priv->mac_addr[2];
3817
3818 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003819 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003820
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003821 bssid[0] &= 0xfe; /* clear multicast bit */
3822 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003823}
3824
Arjan van de Ven858119e2006-01-14 13:20:43 -08003825static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003826{
3827 struct ipw_station_entry entry;
3828 int i;
3829
3830 for (i = 0; i < priv->num_stations; i++) {
3831 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3832 /* Another node is active in network */
3833 priv->missed_adhoc_beacons = 0;
3834 if (!(priv->config & CFG_STATIC_CHANNEL))
3835 /* when other nodes drop out, we drop out */
3836 priv->config &= ~CFG_ADHOC_PERSIST;
3837
3838 return i;
3839 }
3840 }
3841
3842 if (i == MAX_STATIONS)
3843 return IPW_INVALID_STATION;
3844
Johannes Berge1749612008-10-27 15:59:26 -07003845 IPW_DEBUG_SCAN("Adding AdHoc station: %pM\n", bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06003846
3847 entry.reserved = 0;
3848 entry.support_mode = 0;
3849 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3850 memcpy(priv->stations[i], bssid, ETH_ALEN);
3851 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003852 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003853 priv->num_stations++;
3854
3855 return i;
3856}
3857
Arjan van de Ven858119e2006-01-14 13:20:43 -08003858static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003859{
3860 int i;
3861
Jeff Garzikbf794512005-07-31 13:07:26 -04003862 for (i = 0; i < priv->num_stations; i++)
3863 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003864 return i;
3865
3866 return IPW_INVALID_STATION;
3867}
3868
3869static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3870{
3871 int err;
3872
Hong Liu7b996592005-08-25 17:36:13 +08003873 if (priv->status & STATUS_ASSOCIATING) {
3874 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3875 queue_work(priv->workqueue, &priv->disassociate);
3876 return;
3877 }
3878
3879 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003880 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3881 return;
3882 }
3883
Johannes Berge1749612008-10-27 15:59:26 -07003884 IPW_DEBUG_ASSOC("Disassocation attempt from %pM "
James Ketrenos43f66a62005-03-25 12:31:53 -06003885 "on channel %d.\n",
Johannes Berge1749612008-10-27 15:59:26 -07003886 priv->assoc_request.bssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06003887 priv->assoc_request.channel);
3888
3889 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3890 priv->status |= STATUS_DISASSOCIATING;
3891
3892 if (quiet)
3893 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3894 else
3895 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003896
James Ketrenos43f66a62005-03-25 12:31:53 -06003897 err = ipw_send_associate(priv, &priv->assoc_request);
3898 if (err) {
3899 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3900 "failed.\n");
3901 return;
3902 }
3903
3904}
3905
James Ketrenosc848d0a2005-08-24 21:56:24 -05003906static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003907{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003908 struct ipw_priv *priv = data;
3909 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3910 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003911 ipw_send_disassociate(data, 0);
Zhu Yib8ddafd2008-11-27 13:42:20 +08003912 netif_carrier_off(priv->net_dev);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003913 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003914}
3915
David Howellsc4028952006-11-22 14:57:56 +00003916static void ipw_bg_disassociate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06003917{
David Howellsc4028952006-11-22 14:57:56 +00003918 struct ipw_priv *priv =
3919 container_of(work, struct ipw_priv, disassociate);
Zhu Yi46441512006-01-24 16:37:59 +08003920 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00003921 ipw_disassociate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08003922 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003923}
3924
David Howellsc4028952006-11-22 14:57:56 +00003925static void ipw_system_config(struct work_struct *work)
Zhu Yid8bad6d2005-07-13 12:25:38 -05003926{
David Howellsc4028952006-11-22 14:57:56 +00003927 struct ipw_priv *priv =
3928 container_of(work, struct ipw_priv, system_config);
Zhu Yid685b8c2006-04-13 17:20:27 +08003929
3930#ifdef CONFIG_IPW2200_PROMISCUOUS
3931 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3932 priv->sys_config.accept_all_data_frames = 1;
3933 priv->sys_config.accept_non_directed_frames = 1;
3934 priv->sys_config.accept_all_mgmt_bcpr = 1;
3935 priv->sys_config.accept_all_mgmt_frames = 1;
3936 }
3937#endif
3938
3939 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003940}
3941
3942struct ipw_status_code {
3943 u16 status;
3944 const char *reason;
3945};
3946
3947static const struct ipw_status_code ipw_status_codes[] = {
3948 {0x00, "Successful"},
3949 {0x01, "Unspecified failure"},
3950 {0x0A, "Cannot support all requested capabilities in the "
3951 "Capability information field"},
3952 {0x0B, "Reassociation denied due to inability to confirm that "
3953 "association exists"},
3954 {0x0C, "Association denied due to reason outside the scope of this "
3955 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003956 {0x0D,
3957 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003958 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003959 {0x0E,
3960 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003961 "transaction sequence number out of expected sequence"},
3962 {0x0F, "Authentication rejected because of challenge failure"},
3963 {0x10, "Authentication rejected due to timeout waiting for next "
3964 "frame in sequence"},
3965 {0x11, "Association denied because AP is unable to handle additional "
3966 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003967 {0x12,
3968 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003969 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003970 {0x13,
3971 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003972 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003973 {0x14,
3974 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003975 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003976 {0x15,
3977 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003978 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003979 {0x19,
3980 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003981 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003982 {0x1A,
3983 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003984 "DSSS-OFDM operation"},
3985 {0x28, "Invalid Information Element"},
3986 {0x29, "Group Cipher is not valid"},
3987 {0x2A, "Pairwise Cipher is not valid"},
3988 {0x2B, "AKMP is not valid"},
3989 {0x2C, "Unsupported RSN IE version"},
3990 {0x2D, "Invalid RSN IE Capabilities"},
3991 {0x2E, "Cipher suite is rejected per security policy"},
3992};
3993
Jeff Garzikbf794512005-07-31 13:07:26 -04003994static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003995{
3996 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003997 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003998 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003999 return ipw_status_codes[i].reason;
4000 return "Unknown status value.";
4001}
James Ketrenos43f66a62005-03-25 12:31:53 -06004002
4003static void inline average_init(struct average *avg)
4004{
4005 memset(avg, 0, sizeof(*avg));
4006}
4007
Zhu Yi00d21de2006-04-13 17:19:02 +08004008#define DEPTH_RSSI 8
4009#define DEPTH_NOISE 16
4010static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
4011{
4012 return ((depth-1)*prev_avg + val)/depth;
4013}
4014
Arjan van de Ven858119e2006-01-14 13:20:43 -08004015static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06004016{
4017 avg->sum -= avg->entries[avg->pos];
4018 avg->sum += val;
4019 avg->entries[avg->pos++] = val;
4020 if (unlikely(avg->pos == AVG_ENTRIES)) {
4021 avg->init = 1;
4022 avg->pos = 0;
4023 }
4024}
4025
Arjan van de Ven858119e2006-01-14 13:20:43 -08004026static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06004027{
4028 if (!unlikely(avg->init)) {
4029 if (avg->pos)
4030 return avg->sum / avg->pos;
4031 return 0;
4032 }
4033
4034 return avg->sum / AVG_ENTRIES;
4035}
4036
4037static void ipw_reset_stats(struct ipw_priv *priv)
4038{
4039 u32 len = sizeof(u32);
4040
4041 priv->quality = 0;
4042
4043 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08004044 priv->exp_avg_rssi = -60;
4045 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06004046
4047 priv->last_rate = 0;
4048 priv->last_missed_beacons = 0;
4049 priv->last_rx_packets = 0;
4050 priv->last_tx_packets = 0;
4051 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04004052
James Ketrenos43f66a62005-03-25 12:31:53 -06004053 /* Firmware managed, reset only when NIC is restarted, so we have to
4054 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04004055 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06004056 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04004057 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06004058 &priv->last_tx_failures, &len);
4059
4060 /* Driver managed, reset with each association */
4061 priv->missed_adhoc_beacons = 0;
4062 priv->missed_beacons = 0;
4063 priv->tx_packets = 0;
4064 priv->rx_packets = 0;
4065
4066}
4067
Arjan van de Ven858119e2006-01-14 13:20:43 -08004068static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06004069{
4070 u32 i = 0x80000000;
4071 u32 mask = priv->rates_mask;
4072 /* If currently associated in B mode, restrict the maximum
4073 * rate match to B rates */
4074 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
4075 mask &= IEEE80211_CCK_RATES_MASK;
4076
4077 /* TODO: Verify that the rate is supported by the current rates
4078 * list. */
4079
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004080 while (i && !(mask & i))
4081 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06004082 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004083 case IEEE80211_CCK_RATE_1MB_MASK:
4084 return 1000000;
4085 case IEEE80211_CCK_RATE_2MB_MASK:
4086 return 2000000;
4087 case IEEE80211_CCK_RATE_5MB_MASK:
4088 return 5500000;
4089 case IEEE80211_OFDM_RATE_6MB_MASK:
4090 return 6000000;
4091 case IEEE80211_OFDM_RATE_9MB_MASK:
4092 return 9000000;
4093 case IEEE80211_CCK_RATE_11MB_MASK:
4094 return 11000000;
4095 case IEEE80211_OFDM_RATE_12MB_MASK:
4096 return 12000000;
4097 case IEEE80211_OFDM_RATE_18MB_MASK:
4098 return 18000000;
4099 case IEEE80211_OFDM_RATE_24MB_MASK:
4100 return 24000000;
4101 case IEEE80211_OFDM_RATE_36MB_MASK:
4102 return 36000000;
4103 case IEEE80211_OFDM_RATE_48MB_MASK:
4104 return 48000000;
4105 case IEEE80211_OFDM_RATE_54MB_MASK:
4106 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004107 }
4108
Jeff Garzikbf794512005-07-31 13:07:26 -04004109 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004110 return 11000000;
4111 else
4112 return 54000000;
4113}
4114
4115static u32 ipw_get_current_rate(struct ipw_priv *priv)
4116{
4117 u32 rate, len = sizeof(rate);
4118 int err;
4119
Jeff Garzikbf794512005-07-31 13:07:26 -04004120 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004121 return 0;
4122
4123 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004124 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004125 &len);
4126 if (err) {
4127 IPW_DEBUG_INFO("failed querying ordinals.\n");
4128 return 0;
4129 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004130 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004131 return ipw_get_max_rate(priv);
4132
4133 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004134 case IPW_TX_RATE_1MB:
4135 return 1000000;
4136 case IPW_TX_RATE_2MB:
4137 return 2000000;
4138 case IPW_TX_RATE_5MB:
4139 return 5500000;
4140 case IPW_TX_RATE_6MB:
4141 return 6000000;
4142 case IPW_TX_RATE_9MB:
4143 return 9000000;
4144 case IPW_TX_RATE_11MB:
4145 return 11000000;
4146 case IPW_TX_RATE_12MB:
4147 return 12000000;
4148 case IPW_TX_RATE_18MB:
4149 return 18000000;
4150 case IPW_TX_RATE_24MB:
4151 return 24000000;
4152 case IPW_TX_RATE_36MB:
4153 return 36000000;
4154 case IPW_TX_RATE_48MB:
4155 return 48000000;
4156 case IPW_TX_RATE_54MB:
4157 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004158 }
4159
4160 return 0;
4161}
4162
James Ketrenos43f66a62005-03-25 12:31:53 -06004163#define IPW_STATS_INTERVAL (2 * HZ)
4164static void ipw_gather_stats(struct ipw_priv *priv)
4165{
4166 u32 rx_err, rx_err_delta, rx_packets_delta;
4167 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4168 u32 missed_beacons_percent, missed_beacons_delta;
4169 u32 quality = 0;
4170 u32 len = sizeof(u32);
4171 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004172 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004173 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004174 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004175
4176 if (!(priv->status & STATUS_ASSOCIATED)) {
4177 priv->quality = 0;
4178 return;
4179 }
4180
4181 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004182 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004183 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004184 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004185 priv->last_missed_beacons = priv->missed_beacons;
4186 if (priv->assoc_request.beacon_interval) {
4187 missed_beacons_percent = missed_beacons_delta *
Al Viro5b5e8072007-12-27 01:54:06 -05004188 (HZ * le16_to_cpu(priv->assoc_request.beacon_interval)) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004189 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004190 } else {
4191 missed_beacons_percent = 0;
4192 }
4193 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4194
4195 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4196 rx_err_delta = rx_err - priv->last_rx_err;
4197 priv->last_rx_err = rx_err;
4198
4199 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4200 tx_failures_delta = tx_failures - priv->last_tx_failures;
4201 priv->last_tx_failures = tx_failures;
4202
4203 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4204 priv->last_rx_packets = priv->rx_packets;
4205
4206 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4207 priv->last_tx_packets = priv->tx_packets;
4208
4209 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004210 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004211 * Missed beacon: 100% = 0, 0% = 70% missed
4212 * Rate: 60% = 1Mbs, 100% = Max
4213 * Rx and Tx errors represent a straight % of total Rx/Tx
4214 * RSSI: 100% = > -50, 0% = < -80
4215 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004216 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004217 * The lowest computed quality is used.
4218 *
4219 */
4220#define BEACON_THRESHOLD 5
4221 beacon_quality = 100 - missed_beacons_percent;
4222 if (beacon_quality < BEACON_THRESHOLD)
4223 beacon_quality = 0;
4224 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004225 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004226 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004227 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004228 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004229
James Ketrenos43f66a62005-03-25 12:31:53 -06004230 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004231 max_rate = ipw_get_max_rate(priv);
4232 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004233 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4234 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004235
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004236 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004237 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004238 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004239 else
4240 rx_quality = 100;
4241 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4242 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004243
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004244 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004245 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004246 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004247 else
4248 tx_quality = 100;
4249 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4250 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004251
Zhu Yi00d21de2006-04-13 17:19:02 +08004252 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004253 signal_quality =
4254 (100 *
4255 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4256 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4257 (priv->ieee->perfect_rssi - rssi) *
4258 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4259 62 * (priv->ieee->perfect_rssi - rssi))) /
4260 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4261 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4262 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004263 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004264 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004265 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004266
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004267 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004268 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004269
4270 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004271 min(rate_quality,
4272 min(tx_quality, min(rx_quality, signal_quality))));
4273 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004274 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4275 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004276 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004277 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4278 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004279 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004280 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4281 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004282 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004283 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4284 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004285 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004286 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4287 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004288
4289 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004290
4291 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004292 IPW_STATS_INTERVAL);
4293}
4294
David Howellsc4028952006-11-22 14:57:56 +00004295static void ipw_bg_gather_stats(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05004296{
David Howellsc4028952006-11-22 14:57:56 +00004297 struct ipw_priv *priv =
4298 container_of(work, struct ipw_priv, gather_stats.work);
Zhu Yi46441512006-01-24 16:37:59 +08004299 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00004300 ipw_gather_stats(priv);
Zhu Yi46441512006-01-24 16:37:59 +08004301 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004302}
4303
Ben Cahille7582562005-10-06 15:34:41 -05004304/* Missed beacon behavior:
4305 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4306 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4307 * Above disassociate threshold, give up and stop scanning.
4308 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004309static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004310 int missed_count)
4311{
4312 priv->notif_missed_beacons = missed_count;
4313
James Ketrenosafbf30a2005-08-25 00:05:33 -05004314 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004315 priv->status & STATUS_ASSOCIATED) {
4316 /* If associated and we've hit the missed
4317 * beacon threshold, disassociate, turn
4318 * off roaming, and abort any active scans */
4319 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004320 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004321 "Missed beacon: %d - disassociate\n", missed_count);
4322 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004323 if (priv->status & STATUS_SCANNING) {
4324 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4325 IPW_DL_STATE,
4326 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004327 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004328 }
4329
James Ketrenosea2b26e2005-08-24 21:25:16 -05004330 queue_work(priv->workqueue, &priv->disassociate);
4331 return;
4332 }
4333
4334 if (priv->status & STATUS_ROAMING) {
4335 /* If we are currently roaming, then just
4336 * print a debug statement... */
4337 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4338 "Missed beacon: %d - roam in progress\n",
4339 missed_count);
4340 return;
4341 }
4342
Zhu Yi4bfdb912006-01-24 16:37:16 +08004343 if (roaming &&
4344 (missed_count > priv->roaming_threshold &&
4345 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004346 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004347 * bit in the status and kick off a scan.
4348 * This can happen several times before we reach
4349 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004350 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4351 "Missed beacon: %d - initiate "
4352 "roaming\n", missed_count);
4353 if (!(priv->status & STATUS_ROAMING)) {
4354 priv->status |= STATUS_ROAMING;
4355 if (!(priv->status & STATUS_SCANNING))
David Howellsc4028952006-11-22 14:57:56 +00004356 queue_delayed_work(priv->workqueue,
4357 &priv->request_scan, 0);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004358 }
4359 return;
4360 }
4361
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01004362 if (priv->status & STATUS_SCANNING &&
4363 missed_count > IPW_MB_SCAN_CANCEL_THRESHOLD) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004364 /* Stop scan to keep fw from getting
4365 * stuck (only if we aren't roaming --
4366 * otherwise we'll never scan more than 2 or 3
4367 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004368 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4369 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004370 queue_work(priv->workqueue, &priv->abort_scan);
4371 }
4372
4373 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004374}
4375
Dan Williams0b531672007-10-09 13:55:24 -04004376static void ipw_scan_event(struct work_struct *work)
4377{
4378 union iwreq_data wrqu;
4379
4380 struct ipw_priv *priv =
4381 container_of(work, struct ipw_priv, scan_event.work);
4382
4383 wrqu.data.length = 0;
4384 wrqu.data.flags = 0;
4385 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4386}
4387
4388static void handle_scan_event(struct ipw_priv *priv)
4389{
4390 /* Only userspace-requested scan completion events go out immediately */
4391 if (!priv->user_requested_scan) {
4392 if (!delayed_work_pending(&priv->scan_event))
4393 queue_delayed_work(priv->workqueue, &priv->scan_event,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004394 round_jiffies_relative(msecs_to_jiffies(4000)));
Dan Williams0b531672007-10-09 13:55:24 -04004395 } else {
4396 union iwreq_data wrqu;
4397
4398 priv->user_requested_scan = 0;
4399 cancel_delayed_work(&priv->scan_event);
4400
4401 wrqu.data.length = 0;
4402 wrqu.data.flags = 0;
4403 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4404 }
4405}
4406
James Ketrenos43f66a62005-03-25 12:31:53 -06004407/**
4408 * Handle host notification packet.
4409 * Called from interrupt routine
4410 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004411static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004412 struct ipw_rx_notification *notif)
4413{
John W. Linville9387b7c2008-09-30 20:59:05 -04004414 DECLARE_SSID_BUF(ssid);
Al Viroe62e1ee2007-12-27 01:36:46 -05004415 u16 size = le16_to_cpu(notif->size);
James Ketrenosa613bff2005-08-24 21:43:11 -05004416 notif->size = le16_to_cpu(notif->size);
4417
Al Viroe62e1ee2007-12-27 01:36:46 -05004418 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004419
James Ketrenos43f66a62005-03-25 12:31:53 -06004420 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004421 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4422 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004423
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004424 switch (assoc->state) {
4425 case CMAS_ASSOCIATED:{
4426 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4427 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004428 "associated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004429 print_ssid(ssid, priv->essid,
4430 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004431 priv->bssid);
Jeff Garzikbf794512005-07-31 13:07:26 -04004432
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004433 switch (priv->ieee->iw_mode) {
4434 case IW_MODE_INFRA:
4435 memcpy(priv->ieee->bssid,
4436 priv->bssid, ETH_ALEN);
4437 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004438
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004439 case IW_MODE_ADHOC:
4440 memcpy(priv->ieee->bssid,
4441 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004442
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004443 /* clear out the station table */
4444 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004445
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004446 IPW_DEBUG_ASSOC
4447 ("queueing adhoc check\n");
4448 queue_delayed_work(priv->
4449 workqueue,
4450 &priv->
4451 adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05004452 le16_to_cpu(priv->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004453 assoc_request.
Al Viro5b5e8072007-12-27 01:54:06 -05004454 beacon_interval));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004455 break;
4456 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004457
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004458 priv->status &= ~STATUS_ASSOCIATING;
4459 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004460 queue_work(priv->workqueue,
4461 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004462
Zhu Yie43e3c12006-04-13 17:20:45 +08004463#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004464#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
John W. Linville72118012008-09-30 21:43:03 -04004465 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_control))
James Ketrenosafbf30a2005-08-25 00:05:33 -05004466 if ((priv->status & STATUS_AUTH) &&
4467 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4468 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004469 if ((sizeof
4470 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004471 ieee80211_assoc_response)
Al Viroe62e1ee2007-12-27 01:36:46 -05004472 <= size)
4473 && (size <= 2314)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004474 struct
4475 ieee80211_rx_stats
4476 stats = {
Al Viroe62e1ee2007-12-27 01:36:46 -05004477 .len = size - 1,
James Ketrenosb095c382005-08-24 22:04:42 -05004478 };
4479
4480 IPW_DEBUG_QOS
4481 ("QoS Associate "
Al Viroe62e1ee2007-12-27 01:36:46 -05004482 "size %d\n", size);
James Ketrenosb095c382005-08-24 22:04:42 -05004483 ieee80211_rx_mgt(priv->
4484 ieee,
4485 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004486 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004487 *)
4488 &notif->u.raw, &stats);
4489 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004490 }
James Ketrenosb095c382005-08-24 22:04:42 -05004491#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004492
James Ketrenosa613bff2005-08-24 21:43:11 -05004493 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004494
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004495 break;
4496 }
4497
4498 case CMAS_AUTHENTICATED:{
4499 if (priv->
4500 status & (STATUS_ASSOCIATED |
4501 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004502 struct notif_authenticate *auth
4503 = &notif->u.auth;
4504 IPW_DEBUG(IPW_DL_NOTIF |
4505 IPW_DL_STATE |
4506 IPW_DL_ASSOC,
4507 "deauthenticated: '%s' "
Johannes Berge1749612008-10-27 15:59:26 -07004508 "%pM"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004509 ": (0x%04X) - %s \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004510 print_ssid(ssid,
4511 priv->
4512 essid,
4513 priv->
4514 essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004515 priv->bssid,
Al Viro83f7d572008-03-16 22:26:44 +00004516 le16_to_cpu(auth->status),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004517 ipw_get_status_code
Al Viro83f7d572008-03-16 22:26:44 +00004518 (le16_to_cpu
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004519 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004520
4521 priv->status &=
4522 ~(STATUS_ASSOCIATING |
4523 STATUS_AUTH |
4524 STATUS_ASSOCIATED);
4525
James Ketrenosa613bff2005-08-24 21:43:11 -05004526 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004527 break;
4528 }
4529
4530 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4531 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004532 "authenticated: '%s' %pM\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004533 print_ssid(ssid, priv->essid,
4534 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004535 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004536 break;
4537 }
4538
4539 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004540 if (priv->status & STATUS_AUTH) {
4541 struct
4542 ieee80211_assoc_response
4543 *resp;
4544 resp =
4545 (struct
4546 ieee80211_assoc_response
4547 *)&notif->u.raw;
4548 IPW_DEBUG(IPW_DL_NOTIF |
4549 IPW_DL_STATE |
4550 IPW_DL_ASSOC,
4551 "association failed (0x%04X): %s\n",
Al Viro83f7d572008-03-16 22:26:44 +00004552 le16_to_cpu(resp->status),
James Ketrenosea2b26e2005-08-24 21:25:16 -05004553 ipw_get_status_code
Al Viro83f7d572008-03-16 22:26:44 +00004554 (le16_to_cpu
James Ketrenosea2b26e2005-08-24 21:25:16 -05004555 (resp->status)));
4556 }
4557
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004558 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4559 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004560 "disassociated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004561 print_ssid(ssid, priv->essid,
4562 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004563 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004564
4565 priv->status &=
4566 ~(STATUS_DISASSOCIATING |
4567 STATUS_ASSOCIATING |
4568 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004569 if (priv->assoc_network
4570 && (priv->assoc_network->
4571 capability &
4572 WLAN_CAPABILITY_IBSS))
4573 ipw_remove_current_network
4574 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004575
James Ketrenosa613bff2005-08-24 21:43:11 -05004576 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004577
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004578 break;
4579 }
4580
James Ketrenosb095c382005-08-24 22:04:42 -05004581 case CMAS_RX_ASSOC_RESP:
4582 break;
4583
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004584 default:
4585 IPW_ERROR("assoc: unknown (%d)\n",
4586 assoc->state);
4587 break;
4588 }
4589
James Ketrenos43f66a62005-03-25 12:31:53 -06004590 break;
4591 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004592
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004593 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4594 struct notif_authenticate *auth = &notif->u.auth;
4595 switch (auth->state) {
4596 case CMAS_AUTHENTICATED:
4597 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Johannes Berge1749612008-10-27 15:59:26 -07004598 "authenticated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004599 print_ssid(ssid, priv->essid,
4600 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004601 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004602 priv->status |= STATUS_AUTH;
4603 break;
4604
4605 case CMAS_INIT:
4606 if (priv->status & STATUS_AUTH) {
4607 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4608 IPW_DL_ASSOC,
4609 "authentication failed (0x%04X): %s\n",
Al Viro83f7d572008-03-16 22:26:44 +00004610 le16_to_cpu(auth->status),
4611 ipw_get_status_code(le16_to_cpu
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004612 (auth->
4613 status)));
4614 }
4615 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4616 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004617 "deauthenticated: '%s' %pM\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004618 print_ssid(ssid, priv->essid,
4619 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004620 priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06004621
4622 priv->status &= ~(STATUS_ASSOCIATING |
4623 STATUS_AUTH |
4624 STATUS_ASSOCIATED);
4625
James Ketrenosa613bff2005-08-24 21:43:11 -05004626 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004627 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004628
4629 case CMAS_TX_AUTH_SEQ_1:
4630 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4631 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4632 break;
4633 case CMAS_RX_AUTH_SEQ_2:
4634 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4635 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4636 break;
4637 case CMAS_AUTH_SEQ_1_PASS:
4638 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4639 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4640 break;
4641 case CMAS_AUTH_SEQ_1_FAIL:
4642 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4643 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4644 break;
4645 case CMAS_TX_AUTH_SEQ_3:
4646 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4647 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4648 break;
4649 case CMAS_RX_AUTH_SEQ_4:
4650 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4651 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4652 break;
4653 case CMAS_AUTH_SEQ_2_PASS:
4654 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4655 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4656 break;
4657 case CMAS_AUTH_SEQ_2_FAIL:
4658 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4659 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4660 break;
4661 case CMAS_TX_ASSOC:
4662 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4663 IPW_DL_ASSOC, "TX_ASSOC\n");
4664 break;
4665 case CMAS_RX_ASSOC_RESP:
4666 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4667 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004668
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004669 break;
4670 case CMAS_ASSOCIATED:
4671 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4672 IPW_DL_ASSOC, "ASSOCIATED\n");
4673 break;
4674 default:
4675 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4676 auth->state);
4677 break;
4678 }
4679 break;
4680 }
4681
4682 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4683 struct notif_channel_result *x =
4684 &notif->u.channel_result;
4685
Al Viroe62e1ee2007-12-27 01:36:46 -05004686 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004687 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4688 x->channel_num);
4689 } else {
4690 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4691 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004692 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004693 }
4694 break;
4695 }
4696
4697 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4698 struct notif_scan_complete *x = &notif->u.scan_complete;
Al Viroe62e1ee2007-12-27 01:36:46 -05004699 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004700 IPW_DEBUG_SCAN
4701 ("Scan completed: type %d, %d channels, "
4702 "%d status\n", x->scan_type,
4703 x->num_channels, x->status);
4704 } else {
4705 IPW_ERROR("Scan completed of wrong size %d "
4706 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004707 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004708 }
4709
4710 priv->status &=
4711 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4712
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004713 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004714 cancel_delayed_work(&priv->scan_check);
4715
James Ketrenosb095c382005-08-24 22:04:42 -05004716 if (priv->status & STATUS_EXIT_PENDING)
4717 break;
4718
4719 priv->ieee->scans++;
4720
4721#ifdef CONFIG_IPW2200_MONITOR
4722 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004723 priv->status |= STATUS_SCAN_FORCED;
David Howellsc4028952006-11-22 14:57:56 +00004724 queue_delayed_work(priv->workqueue,
4725 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05004726 break;
4727 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004728 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004729#endif /* CONFIG_IPW2200_MONITOR */
4730
Dan Williamsea177302008-06-02 17:51:23 -04004731 /* Do queued direct scans first */
4732 if (priv->status & STATUS_DIRECT_SCAN_PENDING) {
4733 queue_delayed_work(priv->workqueue,
4734 &priv->request_direct_scan, 0);
4735 }
4736
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004737 if (!(priv->status & (STATUS_ASSOCIATED |
4738 STATUS_ASSOCIATING |
4739 STATUS_ROAMING |
4740 STATUS_DISASSOCIATING)))
4741 queue_work(priv->workqueue, &priv->associate);
4742 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004743 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4744 /* If a scan completed and we are in roam mode, then
4745 * the scan that completed was the one requested as a
4746 * result of entering roam... so, schedule the
4747 * roam work */
4748 queue_work(priv->workqueue,
4749 &priv->roam);
4750 else
4751 /* Don't schedule if we aborted the scan */
4752 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004753 } else if (priv->status & STATUS_SCAN_PENDING)
David Howellsc4028952006-11-22 14:57:56 +00004754 queue_delayed_work(priv->workqueue,
4755 &priv->request_scan, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05004756 else if (priv->config & CFG_BACKGROUND_SCAN
4757 && priv->status & STATUS_ASSOCIATED)
4758 queue_delayed_work(priv->workqueue,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07004759 &priv->request_scan,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004760 round_jiffies_relative(HZ));
Zhu Yi07f02e42006-04-13 17:19:25 +08004761
4762 /* Send an empty event to user space.
4763 * We don't send the received data on the event because
4764 * it would require us to do complex transcoding, and
4765 * we want to minimise the work done in the irq handler
4766 * Use a request to extract the data.
4767 * Also, we generate this even for any scan, regardless
4768 * on how the scan was initiated. User space can just
4769 * sync on periodic scan to get fresh data...
4770 * Jean II */
Dan Williams0b531672007-10-09 13:55:24 -04004771 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4772 handle_scan_event(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004773 break;
4774 }
4775
4776 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4777 struct notif_frag_length *x = &notif->u.frag_len;
4778
Al Viroe62e1ee2007-12-27 01:36:46 -05004779 if (size == sizeof(*x))
James Ketrenosa613bff2005-08-24 21:43:11 -05004780 IPW_ERROR("Frag length: %d\n",
4781 le16_to_cpu(x->frag_length));
4782 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004783 IPW_ERROR("Frag length of wrong size %d "
4784 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004785 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004786 break;
4787 }
4788
4789 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4790 struct notif_link_deterioration *x =
4791 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004792
Al Viroe62e1ee2007-12-27 01:36:46 -05004793 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004794 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004795 "link deterioration: type %d, cnt %d\n",
4796 x->silence_notification_type,
4797 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004798 memcpy(&priv->last_link_deterioration, x,
4799 sizeof(*x));
4800 } else {
4801 IPW_ERROR("Link Deterioration of wrong size %d "
4802 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004803 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004804 }
4805 break;
4806 }
4807
4808 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4809 IPW_ERROR("Dino config\n");
4810 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004811 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004812 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004813
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004814 break;
4815 }
4816
4817 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4818 struct notif_beacon_state *x = &notif->u.beacon_state;
Al Viroe62e1ee2007-12-27 01:36:46 -05004819 if (size != sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004820 IPW_ERROR
4821 ("Beacon state of wrong size %d (should "
Al Viroe62e1ee2007-12-27 01:36:46 -05004822 "be %zd)\n", size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004823 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004824 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004825
James Ketrenosa613bff2005-08-24 21:43:11 -05004826 if (le32_to_cpu(x->state) ==
4827 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4828 ipw_handle_missed_beacon(priv,
4829 le32_to_cpu(x->
4830 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004831
James Ketrenos43f66a62005-03-25 12:31:53 -06004832 break;
4833 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004834
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004835 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4836 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
Al Viroe62e1ee2007-12-27 01:36:46 -05004837 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004838 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4839 "0x%02x station %d\n",
4840 x->key_state, x->security_type,
4841 x->station_index);
4842 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004843 }
4844
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004845 IPW_ERROR
4846 ("TGi Tx Key of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004847 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004848 break;
4849 }
4850
4851 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4852 struct notif_calibration *x = &notif->u.calibration;
4853
Al Viroe62e1ee2007-12-27 01:36:46 -05004854 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004855 memcpy(&priv->calib, x, sizeof(*x));
4856 IPW_DEBUG_INFO("TODO: Calibration\n");
4857 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004858 }
4859
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004860 IPW_ERROR
4861 ("Calibration of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004862 size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004864 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004865
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004866 case HOST_NOTIFICATION_NOISE_STATS:{
Al Viroe62e1ee2007-12-27 01:36:46 -05004867 if (size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004868 priv->exp_avg_noise =
4869 exponential_average(priv->exp_avg_noise,
4870 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4871 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004872 break;
4873 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004874
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004875 IPW_ERROR
4876 ("Noise stat is wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004877 size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004878 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004879 }
4880
James Ketrenos43f66a62005-03-25 12:31:53 -06004881 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004882 IPW_DEBUG_NOTIF("Unknown notification: "
4883 "subtype=%d,flags=0x%2x,size=%d\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004884 notif->subtype, notif->flags, size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004885 }
4886}
4887
4888/**
4889 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004890 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004891 * @param priv
4892 * @return error code
4893 */
4894static int ipw_queue_reset(struct ipw_priv *priv)
4895{
4896 int rc = 0;
4897 /** @todo customize queue sizes */
4898 int nTx = 64, nTxCmd = 8;
4899 ipw_tx_queue_free(priv);
4900 /* Tx CMD queue */
4901 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004902 IPW_TX_CMD_QUEUE_READ_INDEX,
4903 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4904 IPW_TX_CMD_QUEUE_BD_BASE,
4905 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004906 if (rc) {
4907 IPW_ERROR("Tx Cmd queue init failed\n");
4908 goto error;
4909 }
4910 /* Tx queue(s) */
4911 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004912 IPW_TX_QUEUE_0_READ_INDEX,
4913 IPW_TX_QUEUE_0_WRITE_INDEX,
4914 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004915 if (rc) {
4916 IPW_ERROR("Tx 0 queue init failed\n");
4917 goto error;
4918 }
4919 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004920 IPW_TX_QUEUE_1_READ_INDEX,
4921 IPW_TX_QUEUE_1_WRITE_INDEX,
4922 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004923 if (rc) {
4924 IPW_ERROR("Tx 1 queue init failed\n");
4925 goto error;
4926 }
4927 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004928 IPW_TX_QUEUE_2_READ_INDEX,
4929 IPW_TX_QUEUE_2_WRITE_INDEX,
4930 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004931 if (rc) {
4932 IPW_ERROR("Tx 2 queue init failed\n");
4933 goto error;
4934 }
4935 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004936 IPW_TX_QUEUE_3_READ_INDEX,
4937 IPW_TX_QUEUE_3_WRITE_INDEX,
4938 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004939 if (rc) {
4940 IPW_ERROR("Tx 3 queue init failed\n");
4941 goto error;
4942 }
4943 /* statistics */
4944 priv->rx_bufs_min = 0;
4945 priv->rx_pend_max = 0;
4946 return rc;
4947
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004948 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004949 ipw_tx_queue_free(priv);
4950 return rc;
4951}
4952
4953/**
4954 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004955 *
Stefano Brivio8ff9d212008-01-12 23:12:26 +01004956 * When FW advances 'R' index, all entries between old and
James Ketrenos43f66a62005-03-25 12:31:53 -06004957 * new 'R' index need to be reclaimed. As result, some free space
4958 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004959 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004960 * @note Need to protect against garbage in 'R' index
4961 * @param priv
4962 * @param txq
4963 * @param qindex
4964 * @return Number of used entries remains in the queue
4965 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004966static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004967 struct clx2_tx_queue *txq, int qindex)
4968{
4969 u32 hw_tail;
4970 int used;
4971 struct clx2_queue *q = &txq->q;
4972
4973 hw_tail = ipw_read32(priv, q->reg_r);
4974 if (hw_tail >= q->n_bd) {
4975 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004976 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4977 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004978 goto done;
4979 }
4980 for (; q->last_used != hw_tail;
4981 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4982 ipw_queue_tx_free_tfd(priv, txq);
4983 priv->tx_packets++;
4984 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004985 done:
Dan Williams943dbef2008-02-14 17:49:41 -05004986 if ((ipw_tx_queue_space(q) > q->low_mark) &&
David S. Miller521c4d92008-07-22 18:32:47 -07004987 (qindex >= 0))
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004988 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004989 used = q->first_empty - q->last_used;
4990 if (used < 0)
4991 used += q->n_bd;
4992
4993 return used;
4994}
4995
4996static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4997 int len, int sync)
4998{
4999 struct clx2_tx_queue *txq = &priv->txq_cmd;
5000 struct clx2_queue *q = &txq->q;
5001 struct tfd_frame *tfd;
5002
Dan Williams943dbef2008-02-14 17:49:41 -05005003 if (ipw_tx_queue_space(q) < (sync ? 1 : 2)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005004 IPW_ERROR("No space for Tx\n");
5005 return -EBUSY;
5006 }
5007
5008 tfd = &txq->bd[q->first_empty];
5009 txq->txb[q->first_empty] = NULL;
5010
5011 memset(tfd, 0, sizeof(*tfd));
5012 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
5013 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
5014 priv->hcmd_seq++;
5015 tfd->u.cmd.index = hcmd;
5016 tfd->u.cmd.length = len;
5017 memcpy(tfd->u.cmd.payload, buf, len);
5018 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
5019 ipw_write32(priv, q->reg_w, q->first_empty);
5020 _ipw_read32(priv, 0x90);
5021
5022 return 0;
5023}
5024
Jeff Garzikbf794512005-07-31 13:07:26 -04005025/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005026 * Rx theory of operation
5027 *
5028 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05005029 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06005030 * 0 to 31
5031 *
5032 * Rx Queue Indexes
5033 * The host/firmware share two index registers for managing the Rx buffers.
5034 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005035 * The READ index maps to the first position that the firmware may be writing
5036 * to -- the driver can read up to (but not including) this position and get
5037 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06005038 * The READ index is managed by the firmware once the card is enabled.
5039 *
5040 * The WRITE index maps to the last position the driver has read from -- the
5041 * position preceding WRITE is the last slot the firmware can place a packet.
5042 *
5043 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04005044 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06005045 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005046 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06005047 * INDEX position, and WRITE to the last (READ - 1 wrapped)
5048 *
5049 * When the firmware places a packet in a buffer it will advance the READ index
5050 * and fire the RX interrupt. The driver can then query the READ index and
5051 * process as many packets as possible, moving the WRITE index forward as it
5052 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04005053 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005054 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04005055 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06005056 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04005057 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06005058 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
5059 * ipw->rxq is replenished and the READ INDEX is updated (updating the
5060 * 'processed' and 'read' driver indexes as well)
5061 * + A received packet is processed and handed to the kernel network stack,
5062 * detached from the ipw->rxq. The driver 'processed' index is updated.
5063 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04005064 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
5065 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06005066 * were enough free buffers and RX_STALLED is set it is cleared.
5067 *
5068 *
5069 * Driver sequence:
5070 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005071 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06005072 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
5073 * ipw_rx_queue_restock
5074 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
5075 * queue, updates firmware pointers, and updates
5076 * the WRITE index. If insufficient rx_free buffers
5077 * are available, schedules ipw_rx_queue_replenish
5078 *
5079 * -- enable interrupts --
5080 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04005081 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06005082 * Moves the packet buffer from queue to rx_used.
5083 * Calls ipw_rx_queue_restock to refill any empty
5084 * slots.
5085 * ...
5086 *
5087 */
5088
Jeff Garzikbf794512005-07-31 13:07:26 -04005089/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005090 * If there are slots in the RX queue that need to be restocked,
5091 * and we have free pre-allocated buffers, fill the ranks as much
5092 * as we can pulling from rx_free.
5093 *
5094 * This moves the 'write' index forward to catch up with 'processed', and
5095 * also updates the memory address in the firmware to reference the new
5096 * target buffer.
5097 */
5098static void ipw_rx_queue_restock(struct ipw_priv *priv)
5099{
5100 struct ipw_rx_queue *rxq = priv->rxq;
5101 struct list_head *element;
5102 struct ipw_rx_mem_buffer *rxb;
5103 unsigned long flags;
5104 int write;
5105
5106 spin_lock_irqsave(&rxq->lock, flags);
5107 write = rxq->write;
Dan Williams943dbef2008-02-14 17:49:41 -05005108 while ((ipw_rx_queue_space(rxq) > 0) && (rxq->free_count)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005109 element = rxq->rx_free.next;
5110 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
5111 list_del(element);
5112
James Ketrenosb095c382005-08-24 22:04:42 -05005113 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005114 rxb->dma_addr);
5115 rxq->queue[rxq->write] = rxb;
5116 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5117 rxq->free_count--;
5118 }
5119 spin_unlock_irqrestore(&rxq->lock, flags);
5120
Jeff Garzikbf794512005-07-31 13:07:26 -04005121 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005122 * refill it */
5123 if (rxq->free_count <= RX_LOW_WATERMARK)
5124 queue_work(priv->workqueue, &priv->rx_replenish);
5125
5126 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005127 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005128 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005129}
5130
5131/*
5132 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005133 * Also restock the Rx queue via ipw_rx_queue_restock.
5134 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005135 * This is called as a scheduled work item (except for during intialization)
5136 */
5137static void ipw_rx_queue_replenish(void *data)
5138{
5139 struct ipw_priv *priv = data;
5140 struct ipw_rx_queue *rxq = priv->rxq;
5141 struct list_head *element;
5142 struct ipw_rx_mem_buffer *rxb;
5143 unsigned long flags;
5144
5145 spin_lock_irqsave(&rxq->lock, flags);
5146 while (!list_empty(&rxq->rx_used)) {
5147 element = rxq->rx_used.next;
5148 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005149 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005150 if (!rxb->skb) {
5151 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5152 priv->net_dev->name);
5153 /* We don't reschedule replenish work here -- we will
5154 * call the restock method and if it still needs
5155 * more buffers it will schedule replenish */
5156 break;
5157 }
5158 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005159
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005160 rxb->dma_addr =
5161 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005162 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005163
James Ketrenos43f66a62005-03-25 12:31:53 -06005164 list_add_tail(&rxb->list, &rxq->rx_free);
5165 rxq->free_count++;
5166 }
5167 spin_unlock_irqrestore(&rxq->lock, flags);
5168
5169 ipw_rx_queue_restock(priv);
5170}
5171
David Howellsc4028952006-11-22 14:57:56 +00005172static void ipw_bg_rx_queue_replenish(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005173{
David Howellsc4028952006-11-22 14:57:56 +00005174 struct ipw_priv *priv =
5175 container_of(work, struct ipw_priv, rx_replenish);
Zhu Yi46441512006-01-24 16:37:59 +08005176 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00005177 ipw_rx_queue_replenish(priv);
Zhu Yi46441512006-01-24 16:37:59 +08005178 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005179}
5180
James Ketrenos43f66a62005-03-25 12:31:53 -06005181/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005182 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005183 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005184 * non NULL it is unmapped and freed
5185 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005186static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005187{
5188 int i;
5189
5190 if (!rxq)
5191 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005192
James Ketrenos43f66a62005-03-25 12:31:53 -06005193 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5194 if (rxq->pool[i].skb != NULL) {
5195 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005196 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005197 dev_kfree_skb(rxq->pool[i].skb);
5198 }
5199 }
5200
5201 kfree(rxq);
5202}
5203
5204static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5205{
5206 struct ipw_rx_queue *rxq;
5207 int i;
5208
Takisc75f4742005-12-01 01:41:45 -08005209 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005210 if (unlikely(!rxq)) {
5211 IPW_ERROR("memory allocation failed\n");
5212 return NULL;
5213 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005214 spin_lock_init(&rxq->lock);
5215 INIT_LIST_HEAD(&rxq->rx_free);
5216 INIT_LIST_HEAD(&rxq->rx_used);
5217
5218 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005219 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005220 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5221
5222 /* Set us so that we have processed and used all buffers, but have
5223 * not restocked the Rx queue with fresh buffers */
5224 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005225 rxq->free_count = 0;
5226
5227 return rxq;
5228}
5229
5230static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5231{
5232 rate &= ~IEEE80211_BASIC_RATE_MASK;
5233 if (ieee_mode == IEEE_A) {
5234 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005235 case IEEE80211_OFDM_RATE_6MB:
5236 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005237 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005238 case IEEE80211_OFDM_RATE_9MB:
5239 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005240 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005241 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005242 return priv->
5243 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005244 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005245 return priv->
5246 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005247 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005248 return priv->
5249 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005250 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005251 return priv->
5252 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005253 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005254 return priv->
5255 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005256 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005257 return priv->
5258 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005259 default:
5260 return 0;
5261 }
5262 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005263
James Ketrenos43f66a62005-03-25 12:31:53 -06005264 /* B and G mixed */
5265 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005266 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005267 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005268 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005269 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005270 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005271 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005272 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005273 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5274 }
5275
5276 /* If we are limited to B modulations, bail at this point */
5277 if (ieee_mode == IEEE_B)
5278 return 0;
5279
5280 /* G */
5281 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005282 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005283 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005284 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005285 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005286 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005287 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005288 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005289 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005290 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005291 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005292 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005293 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005294 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005295 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005296 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005297 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5298 }
5299
5300 return 0;
5301}
5302
Jeff Garzikbf794512005-07-31 13:07:26 -04005303static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005304 const struct ieee80211_network *network,
5305 struct ipw_supported_rates *rates)
5306{
5307 int num_rates, i;
5308
5309 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005310 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005311 rates->num_rates = 0;
5312 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005313 if (!ipw_is_rate_in_mask(priv, network->mode,
5314 network->rates[i])) {
5315
James Ketrenosea2b26e2005-08-24 21:25:16 -05005316 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005317 IPW_DEBUG_SCAN("Adding masked mandatory "
5318 "rate %02X\n",
5319 network->rates[i]);
5320 rates->supported_rates[rates->num_rates++] =
5321 network->rates[i];
5322 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005323 }
5324
James Ketrenos43f66a62005-03-25 12:31:53 -06005325 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5326 network->rates[i], priv->rates_mask);
5327 continue;
5328 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005329
James Ketrenos43f66a62005-03-25 12:31:53 -06005330 rates->supported_rates[rates->num_rates++] = network->rates[i];
5331 }
5332
James Ketrenosa613bff2005-08-24 21:43:11 -05005333 num_rates = min(network->rates_ex_len,
5334 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005335 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005336 if (!ipw_is_rate_in_mask(priv, network->mode,
5337 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005338 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005339 IPW_DEBUG_SCAN("Adding masked mandatory "
5340 "rate %02X\n",
5341 network->rates_ex[i]);
5342 rates->supported_rates[rates->num_rates++] =
5343 network->rates[i];
5344 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005345 }
5346
James Ketrenos43f66a62005-03-25 12:31:53 -06005347 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5348 network->rates_ex[i], priv->rates_mask);
5349 continue;
5350 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005351
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005352 rates->supported_rates[rates->num_rates++] =
5353 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005354 }
5355
James Ketrenosea2b26e2005-08-24 21:25:16 -05005356 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005357}
5358
Arjan van de Ven858119e2006-01-14 13:20:43 -08005359static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005360 const struct ipw_supported_rates *src)
5361{
5362 u8 i;
5363 for (i = 0; i < src->num_rates; i++)
5364 dest->supported_rates[i] = src->supported_rates[i];
5365 dest->num_rates = src->num_rates;
5366}
5367
5368/* TODO: Look at sniffed packets in the air to determine if the basic rate
5369 * mask should ever be used -- right now all callers to add the scan rates are
5370 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5371static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005372 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005373{
Jeff Garzikbf794512005-07-31 13:07:26 -04005374 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005375 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005376
James Ketrenos43f66a62005-03-25 12:31:53 -06005377 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005378 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005379 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005380
5381 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005382 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005383 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005384
5385 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005386 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005387 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005388
5389 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005390 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005391 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005392}
5393
5394static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005395 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005396{
Jeff Garzikbf794512005-07-31 13:07:26 -04005397 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005398 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005399
5400 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005401 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005402 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005403
5404 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005405 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005406 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005407
5408 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005409 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005410 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005411
5412 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005413 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005414 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005415
5416 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005417 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005418 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005419
5420 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005421 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005422 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005423
5424 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005425 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005426 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005427
5428 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005429 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005430 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005431}
5432
5433struct ipw_network_match {
5434 struct ieee80211_network *network;
5435 struct ipw_supported_rates rates;
5436};
5437
James Ketrenosc848d0a2005-08-24 21:56:24 -05005438static int ipw_find_adhoc_network(struct ipw_priv *priv,
5439 struct ipw_network_match *match,
5440 struct ieee80211_network *network,
5441 int roaming)
5442{
5443 struct ipw_supported_rates rates;
John W. Linville9387b7c2008-09-30 20:59:05 -04005444 DECLARE_SSID_BUF(ssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005445
5446 /* Verify that this network's capability is compatible with the
5447 * current mode (AdHoc or Infrastructure) */
5448 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5449 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Johannes Berge1749612008-10-27 15:59:26 -07005450 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded due to "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005451 "capability mismatch.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005452 print_ssid(ssid, network->ssid,
5453 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005454 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005455 return 0;
5456 }
5457
James Ketrenosc848d0a2005-08-24 21:56:24 -05005458 if (unlikely(roaming)) {
5459 /* If we are roaming, then ensure check if this is a valid
5460 * network to try and roam to */
5461 if ((network->ssid_len != match->network->ssid_len) ||
5462 memcmp(network->ssid, match->network->ssid,
5463 network->ssid_len)) {
Johannes Berge1749612008-10-27 15:59:26 -07005464 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005465 "because of non-network ESSID.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005466 print_ssid(ssid, network->ssid,
5467 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005468 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005469 return 0;
5470 }
5471 } else {
5472 /* If an ESSID has been configured then compare the broadcast
5473 * ESSID to ours */
5474 if ((priv->config & CFG_STATIC_ESSID) &&
5475 ((network->ssid_len != priv->essid_len) ||
5476 memcmp(network->ssid, priv->essid,
5477 min(network->ssid_len, priv->essid_len)))) {
5478 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005479
James Ketrenosc848d0a2005-08-24 21:56:24 -05005480 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005481 print_ssid(ssid, network->ssid,
5482 network->ssid_len),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005483 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005484 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005485 "because of ESSID mismatch: '%s'.\n",
Johannes Berge1749612008-10-27 15:59:26 -07005486 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005487 print_ssid(ssid, priv->essid,
5488 priv->essid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005489 return 0;
5490 }
5491 }
5492
5493 /* If the old network rate is better than this one, don't bother
5494 * testing everything else. */
5495
5496 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005497 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5498 "current network.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005499 print_ssid(ssid, match->network->ssid,
5500 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005501 return 0;
5502 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005503 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5504 "current network.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005505 print_ssid(ssid, match->network->ssid,
5506 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005507 return 0;
5508 }
5509
5510 /* Now go through and see if the requested network is valid... */
5511 if (priv->ieee->scan_age != 0 &&
5512 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Johannes Berge1749612008-10-27 15:59:26 -07005513 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005514 "because of age: %ums.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005515 print_ssid(ssid, network->ssid,
5516 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005517 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005518 jiffies_to_msecs(jiffies -
5519 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005520 return 0;
5521 }
5522
5523 if ((priv->config & CFG_STATIC_CHANNEL) &&
5524 (network->channel != priv->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005525 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005526 "because of channel mismatch: %d != %d.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005527 print_ssid(ssid, network->ssid,
5528 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005529 network->bssid,
James Ketrenosc848d0a2005-08-24 21:56:24 -05005530 network->channel, priv->channel);
5531 return 0;
5532 }
5533
5534 /* Verify privacy compatability */
5535 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5536 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Johannes Berge1749612008-10-27 15:59:26 -07005537 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005538 "because of privacy mismatch: %s != %s.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005539 print_ssid(ssid, network->ssid,
5540 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005541 network->bssid,
James Ketrenosafbf30a2005-08-25 00:05:33 -05005542 priv->
5543 capability & CAP_PRIVACY_ON ? "on" : "off",
5544 network->
5545 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5546 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005547 return 0;
5548 }
5549
5550 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Johannes Berge1749612008-10-27 15:59:26 -07005551 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
5552 "because of the same BSSID match: %pM"
John W. Linville9387b7c2008-09-30 20:59:05 -04005553 ".\n", print_ssid(ssid, network->ssid,
5554 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005555 network->bssid,
5556 priv->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005557 return 0;
5558 }
5559
5560 /* Filter out any incompatible freq / mode combinations */
5561 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Johannes Berge1749612008-10-27 15:59:26 -07005562 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005563 "because of invalid frequency/mode "
5564 "combination.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005565 print_ssid(ssid, network->ssid,
5566 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005567 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005568 return 0;
5569 }
5570
5571 /* Ensure that the rates supported by the driver are compatible with
5572 * this AP, including verification of basic rates (mandatory) */
5573 if (!ipw_compatible_rates(priv, network, &rates)) {
Johannes Berge1749612008-10-27 15:59:26 -07005574 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005575 "because configured rate mask excludes "
5576 "AP mandatory rate.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005577 print_ssid(ssid, network->ssid,
5578 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005579 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005580 return 0;
5581 }
5582
5583 if (rates.num_rates == 0) {
Johannes Berge1749612008-10-27 15:59:26 -07005584 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005585 "because of no compatible rates.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005586 print_ssid(ssid, network->ssid,
5587 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005588 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005589 return 0;
5590 }
5591
5592 /* TODO: Perform any further minimal comparititive tests. We do not
5593 * want to put too much policy logic here; intelligent scan selection
5594 * should occur within a generic IEEE 802.11 user space tool. */
5595
5596 /* Set up 'new' AP to this network */
5597 ipw_copy_rates(&match->rates, &rates);
5598 match->network = network;
Johannes Berge1749612008-10-27 15:59:26 -07005599 IPW_DEBUG_MERGE("Network '%s (%pM)' is a viable match.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005600 print_ssid(ssid, network->ssid, network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005601 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005602
5603 return 1;
5604}
5605
David Howellsc4028952006-11-22 14:57:56 +00005606static void ipw_merge_adhoc_network(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005607{
John W. Linville9387b7c2008-09-30 20:59:05 -04005608 DECLARE_SSID_BUF(ssid);
David Howellsc4028952006-11-22 14:57:56 +00005609 struct ipw_priv *priv =
5610 container_of(work, struct ipw_priv, merge_networks);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005611 struct ieee80211_network *network = NULL;
5612 struct ipw_network_match match = {
5613 .network = priv->assoc_network
5614 };
5615
James Ketrenosafbf30a2005-08-25 00:05:33 -05005616 if ((priv->status & STATUS_ASSOCIATED) &&
5617 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005618 /* First pass through ROAM process -- look for a better
5619 * network */
5620 unsigned long flags;
5621
5622 spin_lock_irqsave(&priv->ieee->lock, flags);
5623 list_for_each_entry(network, &priv->ieee->network_list, list) {
5624 if (network != priv->assoc_network)
5625 ipw_find_adhoc_network(priv, &match, network,
5626 1);
5627 }
5628 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5629
5630 if (match.network == priv->assoc_network) {
5631 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5632 "merge to.\n");
5633 return;
5634 }
5635
Zhu Yi46441512006-01-24 16:37:59 +08005636 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005637 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5638 IPW_DEBUG_MERGE("remove network %s\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005639 print_ssid(ssid, priv->essid,
5640 priv->essid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005641 ipw_remove_current_network(priv);
5642 }
5643
5644 ipw_disassociate(priv);
5645 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005646 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005647 return;
5648 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005649}
5650
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005651static int ipw_best_network(struct ipw_priv *priv,
5652 struct ipw_network_match *match,
5653 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005654{
5655 struct ipw_supported_rates rates;
John W. Linville9387b7c2008-09-30 20:59:05 -04005656 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005657
5658 /* Verify that this network's capability is compatible with the
5659 * current mode (AdHoc or Infrastructure) */
5660 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005661 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005662 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5663 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Johannes Berge1749612008-10-27 15:59:26 -07005664 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005665 "capability mismatch.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005666 print_ssid(ssid, network->ssid,
5667 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005668 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005669 return 0;
5670 }
5671
James Ketrenos43f66a62005-03-25 12:31:53 -06005672 if (unlikely(roaming)) {
5673 /* If we are roaming, then ensure check if this is a valid
5674 * network to try and roam to */
5675 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005676 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005677 network->ssid_len)) {
Johannes Berge1749612008-10-27 15:59:26 -07005678 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005679 "because of non-network ESSID.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005680 print_ssid(ssid, network->ssid,
5681 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005682 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005683 return 0;
5684 }
5685 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005686 /* If an ESSID has been configured then compare the broadcast
5687 * ESSID to ours */
5688 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005689 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005690 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005691 min(network->ssid_len, priv->essid_len)))) {
5692 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005693 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005694 print_ssid(ssid, network->ssid,
5695 network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005696 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005697 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005698 "because of ESSID mismatch: '%s'.\n",
Johannes Berge1749612008-10-27 15:59:26 -07005699 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005700 print_ssid(ssid, priv->essid,
5701 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005702 return 0;
5703 }
5704 }
5705
5706 /* If the old network rate is better than this one, don't bother
5707 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005708 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005709 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005710 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005711 print_ssid(ssid, network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005712 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005713 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded because "
5714 "'%s (%pM)' has a stronger signal.\n",
5715 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005716 print_ssid(ssid, match->network->ssid,
5717 match->network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005718 match->network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005719 return 0;
5720 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005721
James Ketrenos43f66a62005-03-25 12:31:53 -06005722 /* If this network has already had an association attempt within the
5723 * last 3 seconds, do not try and associate again... */
5724 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005725 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
Johannes Berge1749612008-10-27 15:59:26 -07005726 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005727 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005728 "assoc attempt).\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005729 print_ssid(ssid, network->ssid,
5730 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005731 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005732 jiffies_to_msecs(jiffies -
5733 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005734 return 0;
5735 }
5736
5737 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005738 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005739 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Johannes Berge1749612008-10-27 15:59:26 -07005740 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005741 "because of age: %ums.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005742 print_ssid(ssid, network->ssid,
5743 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005744 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005745 jiffies_to_msecs(jiffies -
5746 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005747 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005748 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005749
Jeff Garzikbf794512005-07-31 13:07:26 -04005750 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005751 (network->channel != priv->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005752 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005753 "because of channel mismatch: %d != %d.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005754 print_ssid(ssid, network->ssid,
5755 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005756 network->bssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005757 network->channel, priv->channel);
5758 return 0;
5759 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005760
James Ketrenos43f66a62005-03-25 12:31:53 -06005761 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005762 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005763 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Johannes Berge1749612008-10-27 15:59:26 -07005764 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005765 "because of privacy mismatch: %s != %s.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005766 print_ssid(ssid, network->ssid,
5767 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005768 network->bssid,
Jeff Garzikbf794512005-07-31 13:07:26 -04005769 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005770 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005771 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005772 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005773 return 0;
5774 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005775
5776 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005777 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Johannes Berge1749612008-10-27 15:59:26 -07005778 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
5779 "because of BSSID mismatch: %pM.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005780 print_ssid(ssid, network->ssid,
5781 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005782 network->bssid, priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005783 return 0;
5784 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005785
James Ketrenos43f66a62005-03-25 12:31:53 -06005786 /* Filter out any incompatible freq / mode combinations */
5787 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Johannes Berge1749612008-10-27 15:59:26 -07005788 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005789 "because of invalid frequency/mode "
5790 "combination.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005791 print_ssid(ssid, network->ssid,
5792 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005793 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005794 return 0;
5795 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005796
Liu Hong1fe0adb2005-08-19 09:33:10 -05005797 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005798 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005799 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Liu Hong1fe0adb2005-08-19 09:33:10 -05005800 "because of invalid channel in current GEO\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005801 print_ssid(ssid, network->ssid,
5802 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005803 network->bssid);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005804 return 0;
5805 }
5806
James Ketrenosea2b26e2005-08-24 21:25:16 -05005807 /* Ensure that the rates supported by the driver are compatible with
5808 * this AP, including verification of basic rates (mandatory) */
5809 if (!ipw_compatible_rates(priv, network, &rates)) {
Johannes Berge1749612008-10-27 15:59:26 -07005810 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenosea2b26e2005-08-24 21:25:16 -05005811 "because configured rate mask excludes "
5812 "AP mandatory rate.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005813 print_ssid(ssid, network->ssid,
5814 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005815 network->bssid);
James Ketrenosea2b26e2005-08-24 21:25:16 -05005816 return 0;
5817 }
5818
James Ketrenos43f66a62005-03-25 12:31:53 -06005819 if (rates.num_rates == 0) {
Johannes Berge1749612008-10-27 15:59:26 -07005820 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005821 "because of no compatible rates.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005822 print_ssid(ssid, network->ssid,
5823 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005824 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005825 return 0;
5826 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005827
James Ketrenos43f66a62005-03-25 12:31:53 -06005828 /* TODO: Perform any further minimal comparititive tests. We do not
5829 * want to put too much policy logic here; intelligent scan selection
5830 * should occur within a generic IEEE 802.11 user space tool. */
5831
5832 /* Set up 'new' AP to this network */
5833 ipw_copy_rates(&match->rates, &rates);
5834 match->network = network;
5835
Johannes Berge1749612008-10-27 15:59:26 -07005836 IPW_DEBUG_ASSOC("Network '%s (%pM)' is a viable match.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005837 print_ssid(ssid, network->ssid, network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005838 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005839
5840 return 1;
5841}
5842
Jeff Garzikbf794512005-07-31 13:07:26 -04005843static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005844 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005845{
Larry Finger1867b112006-02-28 09:48:28 -06005846 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005847 int i;
5848
James Ketrenos43f66a62005-03-25 12:31:53 -06005849 /*
5850 * For the purposes of scanning, we can set our wireless mode
5851 * to trigger scans across combinations of bands, but when it
5852 * comes to creating a new ad-hoc network, we have tell the FW
5853 * exactly which band to use.
5854 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005855 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005856 * chossen band. Attempting to create a new ad-hoc network
5857 * with an invalid channel for wireless mode will trigger a
5858 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005859 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005860 */
Larry Finger1867b112006-02-28 09:48:28 -06005861 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005862 case IEEE80211_52GHZ_BAND:
5863 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005864 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005865 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005866 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5867 IPW_WARNING("Overriding invalid channel\n");
5868 priv->channel = geo->a[0].channel;
5869 }
5870 break;
5871
5872 case IEEE80211_24GHZ_BAND:
5873 if (priv->ieee->mode & IEEE_G)
5874 network->mode = IEEE_G;
5875 else
5876 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005877 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005878 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005879 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5880 IPW_WARNING("Overriding invalid channel\n");
5881 priv->channel = geo->bg[0].channel;
5882 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005883 break;
5884
5885 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005886 IPW_WARNING("Overriding invalid channel\n");
5887 if (priv->ieee->mode & IEEE_A) {
5888 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005889 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005890 } else if (priv->ieee->mode & IEEE_G) {
5891 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005892 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005893 } else {
5894 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005895 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005896 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005897 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005898 }
5899
5900 network->channel = priv->channel;
5901 priv->config |= CFG_ADHOC_PERSIST;
5902 ipw_create_bssid(priv, network->bssid);
5903 network->ssid_len = priv->essid_len;
5904 memcpy(network->ssid, priv->essid, priv->essid_len);
5905 memset(&network->stats, 0, sizeof(network->stats));
5906 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005907 if (!(priv->config & CFG_PREAMBLE_LONG))
5908 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005909 if (priv->capability & CAP_PRIVACY_ON)
5910 network->capability |= WLAN_CAPABILITY_PRIVACY;
5911 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005912 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005913 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005914 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005915 &priv->rates.supported_rates[network->rates_len],
5916 network->rates_ex_len);
5917 network->last_scanned = 0;
5918 network->flags = 0;
5919 network->last_associate = 0;
5920 network->time_stamp[0] = 0;
5921 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005922 network->beacon_interval = 100; /* Default */
5923 network->listen_interval = 10; /* Default */
5924 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005925 network->wpa_ie_len = 0;
5926 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005927}
5928
James Ketrenosb095c382005-08-24 22:04:42 -05005929static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5930{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005931 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005932
5933 if (!(priv->ieee->sec.flags & (1 << index)))
5934 return;
5935
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005936 key.key_id = index;
5937 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5938 key.security_type = type;
5939 key.station_index = 0; /* always 0 for BSS */
5940 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005941 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005942 key.tx_counter[0] = cpu_to_le32(0);
5943 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005944
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005945 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005946}
5947
5948static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005949{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005950 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005951 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005952
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005953 key.cmd_id = DINO_CMD_WEP_KEY;
5954 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005955
James Ketrenosb095c382005-08-24 22:04:42 -05005956 /* Note: AES keys cannot be set for multiple times.
5957 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005958 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005959 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005960 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005961 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005962 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005963 }
5964
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005965 key.key_size = priv->ieee->sec.key_sizes[i];
5966 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005967
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005968 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005969 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005970}
5971
Zhu Yi1fbfea52005-08-05 17:22:56 +08005972static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5973{
5974 if (priv->ieee->host_encrypt)
5975 return;
5976
5977 switch (level) {
5978 case SEC_LEVEL_3:
5979 priv->sys_config.disable_unicast_decryption = 0;
5980 priv->ieee->host_decrypt = 0;
5981 break;
5982 case SEC_LEVEL_2:
5983 priv->sys_config.disable_unicast_decryption = 1;
5984 priv->ieee->host_decrypt = 1;
5985 break;
5986 case SEC_LEVEL_1:
5987 priv->sys_config.disable_unicast_decryption = 0;
5988 priv->ieee->host_decrypt = 0;
5989 break;
5990 case SEC_LEVEL_0:
5991 priv->sys_config.disable_unicast_decryption = 1;
5992 break;
5993 default:
5994 break;
5995 }
5996}
5997
5998static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5999{
6000 if (priv->ieee->host_encrypt)
6001 return;
6002
6003 switch (level) {
6004 case SEC_LEVEL_3:
6005 priv->sys_config.disable_multicast_decryption = 0;
6006 break;
6007 case SEC_LEVEL_2:
6008 priv->sys_config.disable_multicast_decryption = 1;
6009 break;
6010 case SEC_LEVEL_1:
6011 priv->sys_config.disable_multicast_decryption = 0;
6012 break;
6013 case SEC_LEVEL_0:
6014 priv->sys_config.disable_multicast_decryption = 1;
6015 break;
6016 default:
6017 break;
6018 }
6019}
6020
James Ketrenosb095c382005-08-24 22:04:42 -05006021static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
6022{
6023 switch (priv->ieee->sec.level) {
6024 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006025 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6026 ipw_send_tgi_tx_key(priv,
6027 DCT_FLAG_EXT_SECURITY_CCM,
6028 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006029
Hong Liu567deaf2005-08-31 18:07:22 +08006030 if (!priv->ieee->host_mc_decrypt)
6031 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05006032 break;
6033 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006034 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6035 ipw_send_tgi_tx_key(priv,
6036 DCT_FLAG_EXT_SECURITY_TKIP,
6037 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05006038 break;
6039 case SEC_LEVEL_1:
6040 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05006041 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
6042 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05006043 break;
6044 case SEC_LEVEL_0:
6045 default:
6046 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06006047 }
6048}
6049
6050static void ipw_adhoc_check(void *data)
6051{
6052 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04006053
James Ketrenosafbf30a2005-08-25 00:05:33 -05006054 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06006055 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006056 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
6057 IPW_DL_STATE | IPW_DL_ASSOC,
6058 "Missed beacon: %d - disassociate\n",
6059 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06006060 ipw_remove_current_network(priv);
6061 ipw_disassociate(priv);
6062 return;
6063 }
6064
Jeff Garzikbf794512005-07-31 13:07:26 -04006065 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05006066 le16_to_cpu(priv->assoc_request.beacon_interval));
James Ketrenos43f66a62005-03-25 12:31:53 -06006067}
6068
David Howellsc4028952006-11-22 14:57:56 +00006069static void ipw_bg_adhoc_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006070{
David Howellsc4028952006-11-22 14:57:56 +00006071 struct ipw_priv *priv =
6072 container_of(work, struct ipw_priv, adhoc_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08006073 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006074 ipw_adhoc_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006075 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006076}
6077
James Ketrenos43f66a62005-03-25 12:31:53 -06006078static void ipw_debug_config(struct ipw_priv *priv)
6079{
John W. Linville9387b7c2008-09-30 20:59:05 -04006080 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06006081 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
6082 "[CFG 0x%08X]\n", priv->config);
6083 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006084 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06006085 else
6086 IPW_DEBUG_INFO("Channel unlocked.\n");
6087 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04006088 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04006089 print_ssid(ssid, priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06006090 else
6091 IPW_DEBUG_INFO("ESSID unlocked.\n");
6092 if (priv->config & CFG_STATIC_BSSID)
Johannes Berge1749612008-10-27 15:59:26 -07006093 IPW_DEBUG_INFO("BSSID locked to %pM\n", priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06006094 else
6095 IPW_DEBUG_INFO("BSSID unlocked.\n");
6096 if (priv->capability & CAP_PRIVACY_ON)
6097 IPW_DEBUG_INFO("PRIVACY on\n");
6098 else
6099 IPW_DEBUG_INFO("PRIVACY off\n");
6100 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
6101}
James Ketrenos43f66a62005-03-25 12:31:53 -06006102
Arjan van de Ven858119e2006-01-14 13:20:43 -08006103static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06006104{
6105 /* TODO: Verify that this works... */
6106 struct ipw_fixed_rate fr = {
6107 .tx_rates = priv->rates_mask
6108 };
6109 u32 reg;
6110 u16 mask = 0;
6111
Jeff Garzikbf794512005-07-31 13:07:26 -04006112 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06006113 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04006114
James Ketrenos43f66a62005-03-25 12:31:53 -06006115 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006116 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06006117 /* IEEE_A */
6118 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6119 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006120 IPW_DEBUG_WX
6121 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006122 fr.tx_rates = 0;
6123 break;
6124 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006125
James Ketrenos43f66a62005-03-25 12:31:53 -06006126 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6127 break;
6128
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006129 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006130 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006131 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006132 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6133 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006134 IPW_DEBUG_WX
6135 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006136 fr.tx_rates = 0;
6137 }
6138 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006139 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006140
6141 /* IEEE_G */
6142 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6143 IEEE80211_OFDM_RATES_MASK)) {
6144 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006145 IPW_DEBUG_WX
6146 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006147 fr.tx_rates = 0;
6148 break;
6149 }
6150
6151 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6152 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6153 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6154 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006155
James Ketrenos43f66a62005-03-25 12:31:53 -06006156 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6157 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6158 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6159 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006160
James Ketrenos43f66a62005-03-25 12:31:53 -06006161 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6162 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6163 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6164 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006165
James Ketrenos43f66a62005-03-25 12:31:53 -06006166 fr.tx_rates |= mask;
6167 break;
6168 }
6169
6170 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006171 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006172}
6173
James Ketrenosea2b26e2005-08-24 21:25:16 -05006174static void ipw_abort_scan(struct ipw_priv *priv)
6175{
6176 int err;
6177
6178 if (priv->status & STATUS_SCAN_ABORTING) {
6179 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6180 return;
6181 }
6182 priv->status |= STATUS_SCAN_ABORTING;
6183
6184 err = ipw_send_scan_abort(priv);
6185 if (err)
6186 IPW_DEBUG_HC("Request to abort scan failed.\n");
6187}
6188
James Ketrenosafbf30a2005-08-25 00:05:33 -05006189static void ipw_add_scan_channels(struct ipw_priv *priv,
6190 struct ipw_scan_request_ext *scan,
6191 int scan_type)
6192{
6193 int channel_index = 0;
6194 const struct ieee80211_geo *geo;
6195 int i;
6196
Larry Finger1867b112006-02-28 09:48:28 -06006197 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006198
6199 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6200 int start = channel_index;
6201 for (i = 0; i < geo->a_channels; i++) {
6202 if ((priv->status & STATUS_ASSOCIATED) &&
6203 geo->a[i].channel == priv->channel)
6204 continue;
6205 channel_index++;
6206 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006207 ipw_set_scan_type(scan, channel_index,
6208 geo->a[i].
6209 flags & IEEE80211_CH_PASSIVE_ONLY ?
6210 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6211 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006212 }
6213
6214 if (start != channel_index) {
6215 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6216 (channel_index - start);
6217 channel_index++;
6218 }
6219 }
6220
6221 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6222 int start = channel_index;
6223 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006224 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006225 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6226 /* nop out the list */
6227 [0] = 0
6228 };
6229
6230 u8 channel;
6231 while (channel_index < IPW_SCAN_CHANNELS) {
6232 channel =
6233 priv->speed_scan[priv->speed_scan_pos];
6234 if (channel == 0) {
6235 priv->speed_scan_pos = 0;
6236 channel = priv->speed_scan[0];
6237 }
6238 if ((priv->status & STATUS_ASSOCIATED) &&
6239 channel == priv->channel) {
6240 priv->speed_scan_pos++;
6241 continue;
6242 }
6243
6244 /* If this channel has already been
6245 * added in scan, break from loop
6246 * and this will be the first channel
6247 * in the next scan.
6248 */
6249 if (channels[channel - 1] != 0)
6250 break;
6251
6252 channels[channel - 1] = 1;
6253 priv->speed_scan_pos++;
6254 channel_index++;
6255 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006256 index =
Larry Finger1867b112006-02-28 09:48:28 -06006257 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006258 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006259 geo->bg[index].
6260 flags &
6261 IEEE80211_CH_PASSIVE_ONLY ?
6262 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6263 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006264 }
6265 } else {
6266 for (i = 0; i < geo->bg_channels; i++) {
6267 if ((priv->status & STATUS_ASSOCIATED) &&
6268 geo->bg[i].channel == priv->channel)
6269 continue;
6270 channel_index++;
6271 scan->channels_list[channel_index] =
6272 geo->bg[i].channel;
6273 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006274 geo->bg[i].
6275 flags &
6276 IEEE80211_CH_PASSIVE_ONLY ?
6277 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6278 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006279 }
6280 }
6281
6282 if (start != channel_index) {
6283 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6284 (channel_index - start);
6285 }
6286 }
6287}
6288
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006289static int ipw_passive_dwell_time(struct ipw_priv *priv)
6290{
6291 /* staying on passive channels longer than the DTIM interval during a
6292 * scan, while associated, causes the firmware to cancel the scan
6293 * without notification. Hence, don't stay on passive channels longer
6294 * than the beacon interval.
6295 */
6296 if (priv->status & STATUS_ASSOCIATED
6297 && priv->assoc_network->beacon_interval > 10)
6298 return priv->assoc_network->beacon_interval - 10;
6299 else
6300 return 120;
6301}
6302
Dan Williamsea177302008-06-02 17:51:23 -04006303static int ipw_request_scan_helper(struct ipw_priv *priv, int type, int direct)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006304{
6305 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006306 int err = 0, scan_type;
6307
6308 if (!(priv->status & STATUS_INIT) ||
6309 (priv->status & STATUS_EXIT_PENDING))
6310 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006311
Zhu Yi46441512006-01-24 16:37:59 +08006312 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006313
Dan Williamsea177302008-06-02 17:51:23 -04006314 if (direct && (priv->direct_scan_ssid_len == 0)) {
6315 IPW_DEBUG_HC("Direct scan requested but no SSID to scan for\n");
6316 priv->status &= ~STATUS_DIRECT_SCAN_PENDING;
6317 goto done;
6318 }
6319
James Ketrenosea2b26e2005-08-24 21:25:16 -05006320 if (priv->status & STATUS_SCANNING) {
Dan Williamsea177302008-06-02 17:51:23 -04006321 IPW_DEBUG_HC("Concurrent scan requested. Queuing.\n");
6322 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6323 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006324 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006325 }
6326
James Ketrenosafbf30a2005-08-25 00:05:33 -05006327 if (!(priv->status & STATUS_SCAN_FORCED) &&
6328 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006329 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
Dan Williamsea177302008-06-02 17:51:23 -04006330 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6331 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006332 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006333 }
6334
6335 if (priv->status & STATUS_RF_KILL_MASK) {
Dan Williamsea177302008-06-02 17:51:23 -04006336 IPW_DEBUG_HC("Queuing scan due to RF Kill activation\n");
6337 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6338 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006339 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006340 }
6341
6342 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006343 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006344
Zhu Yi094c4d22006-08-21 11:39:03 +08006345 if (type == IW_SCAN_TYPE_PASSIVE) {
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006346 IPW_DEBUG_WX("use passive scanning\n");
6347 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
Zhu Yi094c4d22006-08-21 11:39:03 +08006348 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006349 cpu_to_le16(ipw_passive_dwell_time(priv));
Zhu Yi094c4d22006-08-21 11:39:03 +08006350 ipw_add_scan_channels(priv, &scan, scan_type);
6351 goto send_request;
6352 }
6353
6354 /* Use active scan by default. */
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006355 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006356 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006357 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006358 else
6359 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006360 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006361
James Ketrenosa613bff2005-08-24 21:43:11 -05006362 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006363 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006364
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006365 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6366 cpu_to_le16(ipw_passive_dwell_time(priv));
Dan Williamsea177302008-06-02 17:51:23 -04006367 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006368
James Ketrenosb095c382005-08-24 22:04:42 -05006369#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006370 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006371 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006372 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006373
Larry Finger1867b112006-02-28 09:48:28 -06006374 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006375 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006376 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006377 channel = priv->channel;
6378 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006379
James Ketrenosb095c382005-08-24 22:04:42 -05006380 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006381 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006382 channel = priv->channel;
6383 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006384
James Ketrenosb095c382005-08-24 22:04:42 -05006385 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006386 band = (u8) (IPW_B_MODE << 6) | 1;
6387 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006388 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006389 }
6390
James Ketrenosb095c382005-08-24 22:04:42 -05006391 scan.channels_list[0] = band;
6392 scan.channels_list[1] = channel;
6393 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006394
James Ketrenosb095c382005-08-24 22:04:42 -05006395 /* NOTE: The card will sit on this channel for this time
6396 * period. Scan aborts are timing sensitive and frequently
6397 * result in firmware restarts. As such, it is best to
6398 * set a small dwell_time here and just keep re-issuing
6399 * scans. Otherwise fast channel hopping will not actually
6400 * hop channels.
6401 *
6402 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006403 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006404 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006405 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006406#endif /* CONFIG_IPW2200_MONITOR */
Dan Williamsea177302008-06-02 17:51:23 -04006407 /* Honor direct scans first, otherwise if we are roaming make
6408 * this a direct scan for the current network. Finally,
6409 * ensure that every other scan is a fast channel hop scan */
6410 if (direct) {
6411 err = ipw_send_ssid(priv, priv->direct_scan_ssid,
6412 priv->direct_scan_ssid_len);
6413 if (err) {
6414 IPW_DEBUG_HC("Attempt to send SSID command "
6415 "failed\n");
6416 goto done;
6417 }
6418
6419 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
6420 } else if ((priv->status & STATUS_ROAMING)
6421 || (!(priv->status & STATUS_ASSOCIATED)
6422 && (priv->config & CFG_STATIC_ESSID)
6423 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006424 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6425 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006426 IPW_DEBUG_HC("Attempt to send SSID command "
6427 "failed.\n");
6428 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006429 }
6430
6431 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006432 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006433 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006434
James Ketrenosafbf30a2005-08-25 00:05:33 -05006435 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006436#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006437 }
6438#endif
6439
Zhu Yi094c4d22006-08-21 11:39:03 +08006440send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006441 err = ipw_send_scan_request_ext(priv, &scan);
6442 if (err) {
6443 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006444 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006445 }
6446
6447 priv->status |= STATUS_SCANNING;
Dan Williamsea177302008-06-02 17:51:23 -04006448 if (direct) {
6449 priv->status &= ~STATUS_DIRECT_SCAN_PENDING;
6450 priv->direct_scan_ssid_len = 0;
6451 } else
6452 priv->status &= ~STATUS_SCAN_PENDING;
6453
James Ketrenosafbf30a2005-08-25 00:05:33 -05006454 queue_delayed_work(priv->workqueue, &priv->scan_check,
6455 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006456done:
Zhu Yi46441512006-01-24 16:37:59 +08006457 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006458 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006459}
6460
David Howellsc4028952006-11-22 14:57:56 +00006461static void ipw_request_passive_scan(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006462{
David Howellsc4028952006-11-22 14:57:56 +00006463 struct ipw_priv *priv =
Dan Williamsea177302008-06-02 17:51:23 -04006464 container_of(work, struct ipw_priv, request_passive_scan.work);
6465 ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE, 0);
David Howellsc4028952006-11-22 14:57:56 +00006466}
6467
6468static void ipw_request_scan(struct work_struct *work)
6469{
6470 struct ipw_priv *priv =
6471 container_of(work, struct ipw_priv, request_scan.work);
Dan Williamsea177302008-06-02 17:51:23 -04006472 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE, 0);
6473}
6474
6475static void ipw_request_direct_scan(struct work_struct *work)
6476{
6477 struct ipw_priv *priv =
6478 container_of(work, struct ipw_priv, request_direct_scan.work);
6479 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE, 1);
David Howellsc4028952006-11-22 14:57:56 +00006480}
6481
6482static void ipw_bg_abort_scan(struct work_struct *work)
6483{
6484 struct ipw_priv *priv =
6485 container_of(work, struct ipw_priv, abort_scan);
Zhu Yi46441512006-01-24 16:37:59 +08006486 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006487 ipw_abort_scan(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006488 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006489}
6490
James Ketrenosea2b26e2005-08-24 21:25:16 -05006491static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6492{
James Ketrenosb095c382005-08-24 22:04:42 -05006493 /* This is called when wpa_supplicant loads and closes the driver
6494 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006495 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006496 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006497}
6498
James Ketrenosea2b26e2005-08-24 21:25:16 -05006499static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6500{
6501 struct ieee80211_device *ieee = priv->ieee;
6502 struct ieee80211_security sec = {
6503 .flags = SEC_AUTH_MODE,
6504 };
6505 int ret = 0;
6506
James Ketrenosafbf30a2005-08-25 00:05:33 -05006507 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006508 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6509 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006510 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006511 sec.auth_mode = WLAN_AUTH_OPEN;
6512 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006513 } else if (value & IW_AUTH_ALG_LEAP) {
6514 sec.auth_mode = WLAN_AUTH_LEAP;
6515 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006516 } else
6517 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006518
6519 if (ieee->set_security)
6520 ieee->set_security(ieee->dev, &sec);
6521 else
6522 ret = -EOPNOTSUPP;
6523
6524 return ret;
6525}
6526
Adrian Bunka73e22b2006-01-21 01:39:42 +01006527static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6528 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006529{
6530 /* make sure WPA is enabled */
6531 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006532}
6533
6534static int ipw_set_rsn_capa(struct ipw_priv *priv,
6535 char *capabilities, int length)
6536{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006537 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6538
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006539 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006540 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006541}
6542
James Ketrenosafbf30a2005-08-25 00:05:33 -05006543/*
6544 * WE-18 support
6545 */
6546
6547/* SIOCSIWGENIE */
6548static int ipw_wx_set_genie(struct net_device *dev,
6549 struct iw_request_info *info,
6550 union iwreq_data *wrqu, char *extra)
6551{
6552 struct ipw_priv *priv = ieee80211_priv(dev);
6553 struct ieee80211_device *ieee = priv->ieee;
6554 u8 *buf;
6555 int err = 0;
6556
6557 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6558 (wrqu->data.length && extra == NULL))
6559 return -EINVAL;
6560
James Ketrenosafbf30a2005-08-25 00:05:33 -05006561 if (wrqu->data.length) {
6562 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6563 if (buf == NULL) {
6564 err = -ENOMEM;
6565 goto out;
6566 }
6567
6568 memcpy(buf, extra, wrqu->data.length);
6569 kfree(ieee->wpa_ie);
6570 ieee->wpa_ie = buf;
6571 ieee->wpa_ie_len = wrqu->data.length;
6572 } else {
6573 kfree(ieee->wpa_ie);
6574 ieee->wpa_ie = NULL;
6575 ieee->wpa_ie_len = 0;
6576 }
6577
6578 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6579 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006580 return err;
6581}
6582
6583/* SIOCGIWGENIE */
6584static int ipw_wx_get_genie(struct net_device *dev,
6585 struct iw_request_info *info,
6586 union iwreq_data *wrqu, char *extra)
6587{
6588 struct ipw_priv *priv = ieee80211_priv(dev);
6589 struct ieee80211_device *ieee = priv->ieee;
6590 int err = 0;
6591
James Ketrenosafbf30a2005-08-25 00:05:33 -05006592 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6593 wrqu->data.length = 0;
6594 goto out;
6595 }
6596
6597 if (wrqu->data.length < ieee->wpa_ie_len) {
6598 err = -E2BIG;
6599 goto out;
6600 }
6601
6602 wrqu->data.length = ieee->wpa_ie_len;
6603 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6604
6605 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006606 return err;
6607}
6608
Zhu Yi1fbfea52005-08-05 17:22:56 +08006609static int wext_cipher2level(int cipher)
6610{
6611 switch (cipher) {
6612 case IW_AUTH_CIPHER_NONE:
6613 return SEC_LEVEL_0;
6614 case IW_AUTH_CIPHER_WEP40:
6615 case IW_AUTH_CIPHER_WEP104:
6616 return SEC_LEVEL_1;
6617 case IW_AUTH_CIPHER_TKIP:
6618 return SEC_LEVEL_2;
6619 case IW_AUTH_CIPHER_CCMP:
6620 return SEC_LEVEL_3;
6621 default:
6622 return -1;
6623 }
6624}
6625
James Ketrenosafbf30a2005-08-25 00:05:33 -05006626/* SIOCSIWAUTH */
6627static int ipw_wx_set_auth(struct net_device *dev,
6628 struct iw_request_info *info,
6629 union iwreq_data *wrqu, char *extra)
6630{
6631 struct ipw_priv *priv = ieee80211_priv(dev);
6632 struct ieee80211_device *ieee = priv->ieee;
6633 struct iw_param *param = &wrqu->param;
John W. Linville274bfb82008-10-29 11:35:05 -04006634 struct lib80211_crypt_data *crypt;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006635 unsigned long flags;
6636 int ret = 0;
6637
6638 switch (param->flags & IW_AUTH_INDEX) {
6639 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006640 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006641 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006642 ipw_set_hw_decrypt_unicast(priv,
6643 wext_cipher2level(param->value));
6644 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006645 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006646 ipw_set_hw_decrypt_multicast(priv,
6647 wext_cipher2level(param->value));
6648 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006649 case IW_AUTH_KEY_MGMT:
6650 /*
6651 * ipw2200 does not use these parameters
6652 */
6653 break;
6654
6655 case IW_AUTH_TKIP_COUNTERMEASURES:
John W. Linville274bfb82008-10-29 11:35:05 -04006656 crypt = priv->ieee->crypt_info.crypt[priv->ieee->crypt_info.tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006657 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006658 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006659
6660 flags = crypt->ops->get_flags(crypt->priv);
6661
6662 if (param->value)
6663 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6664 else
6665 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6666
6667 crypt->ops->set_flags(flags, crypt->priv);
6668
6669 break;
6670
6671 case IW_AUTH_DROP_UNENCRYPTED:{
6672 /* HACK:
6673 *
6674 * wpa_supplicant calls set_wpa_enabled when the driver
6675 * is loaded and unloaded, regardless of if WPA is being
6676 * used. No other calls are made which can be used to
6677 * determine if encryption will be used or not prior to
6678 * association being expected. If encryption is not being
6679 * used, drop_unencrypted is set to false, else true -- we
6680 * can use this to determine if the CAP_PRIVACY_ON bit should
6681 * be set.
6682 */
6683 struct ieee80211_security sec = {
6684 .flags = SEC_ENABLED,
6685 .enabled = param->value,
6686 };
6687 priv->ieee->drop_unencrypted = param->value;
6688 /* We only change SEC_LEVEL for open mode. Others
6689 * are set by ipw_wpa_set_encryption.
6690 */
6691 if (!param->value) {
6692 sec.flags |= SEC_LEVEL;
6693 sec.level = SEC_LEVEL_0;
6694 } else {
6695 sec.flags |= SEC_LEVEL;
6696 sec.level = SEC_LEVEL_1;
6697 }
6698 if (priv->ieee->set_security)
6699 priv->ieee->set_security(priv->ieee->dev, &sec);
6700 break;
6701 }
6702
6703 case IW_AUTH_80211_AUTH_ALG:
6704 ret = ipw_wpa_set_auth_algs(priv, param->value);
6705 break;
6706
6707 case IW_AUTH_WPA_ENABLED:
6708 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006709 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006710 break;
6711
6712 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6713 ieee->ieee802_1x = param->value;
6714 break;
6715
James Ketrenosafbf30a2005-08-25 00:05:33 -05006716 case IW_AUTH_PRIVACY_INVOKED:
6717 ieee->privacy_invoked = param->value;
6718 break;
6719
6720 default:
6721 return -EOPNOTSUPP;
6722 }
6723 return ret;
6724}
6725
6726/* SIOCGIWAUTH */
6727static int ipw_wx_get_auth(struct net_device *dev,
6728 struct iw_request_info *info,
6729 union iwreq_data *wrqu, char *extra)
6730{
6731 struct ipw_priv *priv = ieee80211_priv(dev);
6732 struct ieee80211_device *ieee = priv->ieee;
John W. Linville274bfb82008-10-29 11:35:05 -04006733 struct lib80211_crypt_data *crypt;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006734 struct iw_param *param = &wrqu->param;
6735 int ret = 0;
6736
6737 switch (param->flags & IW_AUTH_INDEX) {
6738 case IW_AUTH_WPA_VERSION:
6739 case IW_AUTH_CIPHER_PAIRWISE:
6740 case IW_AUTH_CIPHER_GROUP:
6741 case IW_AUTH_KEY_MGMT:
6742 /*
6743 * wpa_supplicant will control these internally
6744 */
6745 ret = -EOPNOTSUPP;
6746 break;
6747
6748 case IW_AUTH_TKIP_COUNTERMEASURES:
John W. Linville274bfb82008-10-29 11:35:05 -04006749 crypt = priv->ieee->crypt_info.crypt[priv->ieee->crypt_info.tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006750 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006751 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006752
6753 param->value = (crypt->ops->get_flags(crypt->priv) &
6754 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6755
6756 break;
6757
6758 case IW_AUTH_DROP_UNENCRYPTED:
6759 param->value = ieee->drop_unencrypted;
6760 break;
6761
6762 case IW_AUTH_80211_AUTH_ALG:
6763 param->value = ieee->sec.auth_mode;
6764 break;
6765
6766 case IW_AUTH_WPA_ENABLED:
6767 param->value = ieee->wpa_enabled;
6768 break;
6769
6770 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6771 param->value = ieee->ieee802_1x;
6772 break;
6773
6774 case IW_AUTH_ROAMING_CONTROL:
6775 case IW_AUTH_PRIVACY_INVOKED:
6776 param->value = ieee->privacy_invoked;
6777 break;
6778
6779 default:
6780 return -EOPNOTSUPP;
6781 }
6782 return 0;
6783}
6784
6785/* SIOCSIWENCODEEXT */
6786static int ipw_wx_set_encodeext(struct net_device *dev,
6787 struct iw_request_info *info,
6788 union iwreq_data *wrqu, char *extra)
6789{
6790 struct ipw_priv *priv = ieee80211_priv(dev);
6791 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6792
6793 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006794 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006795 /* IPW HW can't build TKIP MIC,
6796 host decryption still needed */
6797 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6798 priv->ieee->host_mc_decrypt = 1;
6799 else {
6800 priv->ieee->host_encrypt = 0;
6801 priv->ieee->host_encrypt_msdu = 1;
6802 priv->ieee->host_decrypt = 1;
6803 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006804 } else {
6805 priv->ieee->host_encrypt = 0;
6806 priv->ieee->host_encrypt_msdu = 0;
6807 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006808 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006809 }
6810 }
6811
6812 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6813}
6814
6815/* SIOCGIWENCODEEXT */
6816static int ipw_wx_get_encodeext(struct net_device *dev,
6817 struct iw_request_info *info,
6818 union iwreq_data *wrqu, char *extra)
6819{
6820 struct ipw_priv *priv = ieee80211_priv(dev);
6821 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6822}
6823
6824/* SIOCSIWMLME */
6825static int ipw_wx_set_mlme(struct net_device *dev,
6826 struct iw_request_info *info,
6827 union iwreq_data *wrqu, char *extra)
6828{
6829 struct ipw_priv *priv = ieee80211_priv(dev);
6830 struct iw_mlme *mlme = (struct iw_mlme *)extra;
Al Viroe62e1ee2007-12-27 01:36:46 -05006831 __le16 reason;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006832
6833 reason = cpu_to_le16(mlme->reason_code);
6834
6835 switch (mlme->cmd) {
6836 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006837 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006838 break;
6839
6840 case IW_MLME_DISASSOC:
6841 ipw_disassociate(priv);
6842 break;
6843
6844 default:
6845 return -EOPNOTSUPP;
6846 }
6847 return 0;
6848}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006849
Zhu Yie43e3c12006-04-13 17:20:45 +08006850#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006851
6852/* QoS */
6853/*
6854* get the modulation type of the current network or
6855* the card current mode
6856*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006857static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006858{
6859 u8 mode = 0;
6860
6861 if (priv->status & STATUS_ASSOCIATED) {
6862 unsigned long flags;
6863
6864 spin_lock_irqsave(&priv->ieee->lock, flags);
6865 mode = priv->assoc_network->mode;
6866 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6867 } else {
6868 mode = priv->ieee->mode;
6869 }
6870 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6871 return mode;
6872}
6873
6874/*
6875* Handle management frame beacon and probe response
6876*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006877static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6878 int active_network,
6879 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006880{
6881 u32 size = sizeof(struct ieee80211_qos_parameters);
6882
James Ketrenosafbf30a2005-08-25 00:05:33 -05006883 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006884 network->qos_data.active = network->qos_data.supported;
6885
6886 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006887 if (active_network &&
6888 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006889 network->qos_data.active = network->qos_data.supported;
6890
6891 if ((network->qos_data.active == 1) && (active_network == 1) &&
6892 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6893 (network->qos_data.old_param_count !=
6894 network->qos_data.param_count)) {
6895 network->qos_data.old_param_count =
6896 network->qos_data.param_count;
6897 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006898 IPW_DEBUG_QOS("QoS parameters change call "
6899 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006900 }
6901 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006902 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6903 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006904 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006905 else
6906 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006907 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006908
James Ketrenosb095c382005-08-24 22:04:42 -05006909 if ((network->qos_data.active == 1) && (active_network == 1)) {
6910 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6911 schedule_work(&priv->qos_activate);
6912 }
6913
6914 network->qos_data.active = 0;
6915 network->qos_data.supported = 0;
6916 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006917 if ((priv->status & STATUS_ASSOCIATED) &&
6918 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6919 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
John W. Linvillec5d3dce2008-09-30 17:17:26 -04006920 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006921 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006922 priv->assoc_network->ssid_len) &&
6923 !memcmp(network->ssid,
6924 priv->assoc_network->ssid,
6925 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006926 queue_work(priv->workqueue,
6927 &priv->merge_networks);
6928 }
James Ketrenosb095c382005-08-24 22:04:42 -05006929 }
6930
6931 return 0;
6932}
6933
6934/*
6935* This function set up the firmware to support QoS. It sends
6936* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6937*/
6938static int ipw_qos_activate(struct ipw_priv *priv,
6939 struct ieee80211_qos_data *qos_network_data)
6940{
6941 int err;
6942 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6943 struct ieee80211_qos_parameters *active_one = NULL;
6944 u32 size = sizeof(struct ieee80211_qos_parameters);
6945 u32 burst_duration;
6946 int i;
6947 u8 type;
6948
6949 type = ipw_qos_current_mode(priv);
6950
6951 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6952 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6953 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6954 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6955
6956 if (qos_network_data == NULL) {
6957 if (type == IEEE_B) {
6958 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6959 active_one = &def_parameters_CCK;
6960 } else
6961 active_one = &def_parameters_OFDM;
6962
James Ketrenosafbf30a2005-08-25 00:05:33 -05006963 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006964 burst_duration = ipw_qos_get_burst_duration(priv);
6965 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006966 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Al Viro8fffc152007-12-27 01:25:40 -05006967 cpu_to_le16(burst_duration);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006968 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006969 if (type == IEEE_B) {
6970 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6971 type);
6972 if (priv->qos_data.qos_enable == 0)
6973 active_one = &def_parameters_CCK;
6974 else
6975 active_one = priv->qos_data.def_qos_parm_CCK;
6976 } else {
6977 if (priv->qos_data.qos_enable == 0)
6978 active_one = &def_parameters_OFDM;
6979 else
6980 active_one = priv->qos_data.def_qos_parm_OFDM;
6981 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006982 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006983 } else {
6984 unsigned long flags;
6985 int active;
6986
6987 spin_lock_irqsave(&priv->ieee->lock, flags);
6988 active_one = &(qos_network_data->parameters);
6989 qos_network_data->old_param_count =
6990 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006991 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006992 active = qos_network_data->supported;
6993 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6994
6995 if (active == 0) {
6996 burst_duration = ipw_qos_get_burst_duration(priv);
6997 for (i = 0; i < QOS_QUEUE_NUM; i++)
6998 qos_parameters[QOS_PARAM_SET_ACTIVE].
Al Viro8fffc152007-12-27 01:25:40 -05006999 tx_op_limit[i] = cpu_to_le16(burst_duration);
James Ketrenosb095c382005-08-24 22:04:42 -05007000 }
7001 }
7002
7003 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05007004 err = ipw_send_qos_params_command(priv,
7005 (struct ieee80211_qos_parameters *)
7006 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05007007 if (err)
7008 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
7009
7010 return err;
7011}
7012
7013/*
7014* send IPW_CMD_WME_INFO to the firmware
7015*/
7016static int ipw_qos_set_info_element(struct ipw_priv *priv)
7017{
7018 int ret = 0;
7019 struct ieee80211_qos_information_element qos_info;
7020
7021 if (priv == NULL)
7022 return -1;
7023
7024 qos_info.elementID = QOS_ELEMENT_ID;
7025 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
7026
7027 qos_info.version = QOS_VERSION_1;
7028 qos_info.ac_info = 0;
7029
7030 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
7031 qos_info.qui_type = QOS_OUI_TYPE;
7032 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
7033
7034 ret = ipw_send_qos_info_command(priv, &qos_info);
7035 if (ret != 0) {
7036 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
7037 }
7038 return ret;
7039}
7040
7041/*
7042* Set the QoS parameter with the association request structure
7043*/
7044static int ipw_qos_association(struct ipw_priv *priv,
7045 struct ieee80211_network *network)
7046{
7047 int err = 0;
7048 struct ieee80211_qos_data *qos_data = NULL;
7049 struct ieee80211_qos_data ibss_data = {
7050 .supported = 1,
7051 .active = 1,
7052 };
7053
7054 switch (priv->ieee->iw_mode) {
7055 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02007056 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05007057
7058 qos_data = &ibss_data;
7059 break;
7060
7061 case IW_MODE_INFRA:
7062 qos_data = &network->qos_data;
7063 break;
7064
7065 default:
7066 BUG();
7067 break;
7068 }
7069
7070 err = ipw_qos_activate(priv, qos_data);
7071 if (err) {
7072 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
7073 return err;
7074 }
7075
7076 if (priv->qos_data.qos_enable && qos_data->supported) {
7077 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
7078 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
7079 return ipw_qos_set_info_element(priv);
7080 }
7081
7082 return 0;
7083}
7084
7085/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01007086* handling the beaconing responses. if we get different QoS setting
7087* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05007088* setting
7089*/
7090static int ipw_qos_association_resp(struct ipw_priv *priv,
7091 struct ieee80211_network *network)
7092{
7093 int ret = 0;
7094 unsigned long flags;
7095 u32 size = sizeof(struct ieee80211_qos_parameters);
7096 int set_qos_param = 0;
7097
James Ketrenosafbf30a2005-08-25 00:05:33 -05007098 if ((priv == NULL) || (network == NULL) ||
7099 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05007100 return ret;
7101
7102 if (!(priv->status & STATUS_ASSOCIATED))
7103 return ret;
7104
James Ketrenosafbf30a2005-08-25 00:05:33 -05007105 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05007106 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05007107
7108 spin_lock_irqsave(&priv->ieee->lock, flags);
7109 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007110 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05007111 sizeof(struct ieee80211_qos_data));
7112 priv->assoc_network->qos_data.active = 1;
7113 if ((network->qos_data.old_param_count !=
7114 network->qos_data.param_count)) {
7115 set_qos_param = 1;
7116 network->qos_data.old_param_count =
7117 network->qos_data.param_count;
7118 }
7119
7120 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007121 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
7122 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007123 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007124 else
7125 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007126 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05007127 priv->assoc_network->qos_data.active = 0;
7128 priv->assoc_network->qos_data.supported = 0;
7129 set_qos_param = 1;
7130 }
7131
7132 spin_unlock_irqrestore(&priv->ieee->lock, flags);
7133
7134 if (set_qos_param == 1)
7135 schedule_work(&priv->qos_activate);
7136
7137 return ret;
7138}
7139
7140static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
7141{
7142 u32 ret = 0;
7143
7144 if ((priv == NULL))
7145 return 0;
7146
James Ketrenosafbf30a2005-08-25 00:05:33 -05007147 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05007148 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007149 else
James Ketrenosb095c382005-08-24 22:04:42 -05007150 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007151
James Ketrenosb095c382005-08-24 22:04:42 -05007152 return ret;
7153}
7154
7155/*
7156* Initialize the setting of QoS global
7157*/
7158static void ipw_qos_init(struct ipw_priv *priv, int enable,
7159 int burst_enable, u32 burst_duration_CCK,
7160 u32 burst_duration_OFDM)
7161{
7162 priv->qos_data.qos_enable = enable;
7163
7164 if (priv->qos_data.qos_enable) {
7165 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7166 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7167 IPW_DEBUG_QOS("QoS is enabled\n");
7168 } else {
7169 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7170 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7171 IPW_DEBUG_QOS("QoS is not enabled\n");
7172 }
7173
7174 priv->qos_data.burst_enable = burst_enable;
7175
7176 if (burst_enable) {
7177 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7178 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7179 } else {
7180 priv->qos_data.burst_duration_CCK = 0;
7181 priv->qos_data.burst_duration_OFDM = 0;
7182 }
7183}
7184
7185/*
7186* map the packet priority to the right TX Queue
7187*/
7188static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7189{
7190 if (priority > 7 || !priv->qos_data.qos_enable)
7191 priority = 0;
7192
7193 return from_priority_to_tx_queue[priority] - 1;
7194}
7195
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007196static int ipw_is_qos_active(struct net_device *dev,
7197 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007198{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007199 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007200 struct ieee80211_qos_data *qos_data = NULL;
7201 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007202 u8 *daddr = skb->data + ETH_ALEN;
7203 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007204
7205 if (!(priv->status & STATUS_ASSOCIATED))
7206 return 0;
7207
7208 qos_data = &priv->assoc_network->qos_data;
7209
James Ketrenosb095c382005-08-24 22:04:42 -05007210 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7211 if (unicast == 0)
7212 qos_data->active = 0;
7213 else
7214 qos_data->active = qos_data->supported;
7215 }
James Ketrenosb095c382005-08-24 22:04:42 -05007216 active = qos_data->active;
7217 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007218 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7219 "unicast %d\n",
7220 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007221 if (active && priv->qos_data.qos_enable)
7222 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007223
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007224 return 0;
7225
7226}
7227/*
7228* add QoS parameter to the TX command
7229*/
7230static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7231 u16 priority,
7232 struct tfd_data *tfd)
7233{
7234 int tx_queue_id = 0;
7235
7236
7237 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7238 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7239
7240 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7241 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007242 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007243 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007244 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007245}
7246
7247/*
7248* background support to run QoS activate functionality
7249*/
David Howellsc4028952006-11-22 14:57:56 +00007250static void ipw_bg_qos_activate(struct work_struct *work)
James Ketrenosb095c382005-08-24 22:04:42 -05007251{
David Howellsc4028952006-11-22 14:57:56 +00007252 struct ipw_priv *priv =
7253 container_of(work, struct ipw_priv, qos_activate);
James Ketrenosb095c382005-08-24 22:04:42 -05007254
7255 if (priv == NULL)
7256 return;
7257
Zhu Yi46441512006-01-24 16:37:59 +08007258 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007259
7260 if (priv->status & STATUS_ASSOCIATED)
7261 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7262
Zhu Yi46441512006-01-24 16:37:59 +08007263 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007264}
7265
James Ketrenos3b9990c2005-08-19 13:18:55 -05007266static int ipw_handle_probe_response(struct net_device *dev,
7267 struct ieee80211_probe_response *resp,
7268 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007269{
7270 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007271 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7272 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007273
James Ketrenos3b9990c2005-08-19 13:18:55 -05007274 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007275
James Ketrenos3b9990c2005-08-19 13:18:55 -05007276 return 0;
7277}
James Ketrenosb095c382005-08-24 22:04:42 -05007278
James Ketrenos3b9990c2005-08-19 13:18:55 -05007279static int ipw_handle_beacon(struct net_device *dev,
7280 struct ieee80211_beacon *resp,
7281 struct ieee80211_network *network)
7282{
7283 struct ipw_priv *priv = ieee80211_priv(dev);
7284 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7285 (network == priv->assoc_network));
7286
7287 ipw_qos_handle_probe_response(priv, active_network, network);
7288
7289 return 0;
7290}
7291
7292static int ipw_handle_assoc_response(struct net_device *dev,
7293 struct ieee80211_assoc_response *resp,
7294 struct ieee80211_network *network)
7295{
7296 struct ipw_priv *priv = ieee80211_priv(dev);
7297 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007298 return 0;
7299}
7300
7301static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7302 *qos_param)
7303{
Zhu Yi4e226992006-01-24 16:37:36 +08007304 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7305 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007306}
7307
7308static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7309 *qos_param)
7310{
Zhu Yi4e226992006-01-24 16:37:36 +08007311 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7312 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007313}
7314
Zhu Yie43e3c12006-04-13 17:20:45 +08007315#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007316
James Ketrenos43f66a62005-03-25 12:31:53 -06007317static int ipw_associate_network(struct ipw_priv *priv,
7318 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007319 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007320{
7321 int err;
John W. Linville9387b7c2008-09-30 20:59:05 -04007322 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007323
7324 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007325 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007326
7327 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007328 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007329 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007330 memcpy(priv->essid, network->ssid, priv->essid_len);
7331 }
7332
7333 network->last_associate = jiffies;
7334
7335 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7336 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007337 priv->assoc_request.auth_key = 0;
7338
James Ketrenos43f66a62005-03-25 12:31:53 -06007339 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007340 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007341 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007342 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7343
Zhu Yi1ba61e02006-02-15 13:00:55 +08007344 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007345 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007346
7347 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7348 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7349 priv->assoc_request.auth_type = AUTH_LEAP;
7350 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007351 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007352
James Ketrenosa613bff2005-08-24 21:43:11 -05007353 if (priv->ieee->wpa_ie_len) {
Al Viro5b5e8072007-12-27 01:54:06 -05007354 priv->assoc_request.policy_support = cpu_to_le16(0x02); /* RSN active */
James Ketrenosea2b26e2005-08-24 21:25:16 -05007355 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7356 priv->ieee->wpa_ie_len);
7357 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007358
Jeff Garzikbf794512005-07-31 13:07:26 -04007359 /*
7360 * It is valid for our ieee device to support multiple modes, but
7361 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007362 * just one mode.
7363 */
7364 if (network->mode & priv->ieee->mode & IEEE_A)
7365 priv->assoc_request.ieee_mode = IPW_A_MODE;
7366 else if (network->mode & priv->ieee->mode & IEEE_G)
7367 priv->assoc_request.ieee_mode = IPW_G_MODE;
7368 else if (network->mode & priv->ieee->mode & IEEE_B)
7369 priv->assoc_request.ieee_mode = IPW_B_MODE;
7370
Al Viro5b5e8072007-12-27 01:54:06 -05007371 priv->assoc_request.capability = cpu_to_le16(network->capability);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007372 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7373 && !(priv->config & CFG_PREAMBLE_LONG)) {
7374 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7375 } else {
7376 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7377
7378 /* Clear the short preamble if we won't be supporting it */
7379 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007380 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_PREAMBLE);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007381 }
7382
James Ketrenosafbf30a2005-08-25 00:05:33 -05007383 /* Clear capability bits that aren't used in Ad Hoc */
7384 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7385 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007386 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007387
James Ketrenos43f66a62005-03-25 12:31:53 -06007388 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007389 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007390 roaming ? "Rea" : "A",
John W. Linville9387b7c2008-09-30 20:59:05 -04007391 print_ssid(ssid, priv->essid, priv->essid_len),
Jeff Garzikbf794512005-07-31 13:07:26 -04007392 network->channel,
7393 ipw_modes[priv->assoc_request.ieee_mode],
7394 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007395 (priv->assoc_request.preamble_length ==
7396 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7397 network->capability &
7398 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007399 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007400 priv->capability & CAP_PRIVACY_ON ?
7401 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007402 "(open)") : "",
7403 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007404 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007405 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007406 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007407
Al Viro5b5e8072007-12-27 01:54:06 -05007408 priv->assoc_request.beacon_interval = cpu_to_le16(network->beacon_interval);
James Ketrenos43f66a62005-03-25 12:31:53 -06007409 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007410 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007411 priv->assoc_request.assoc_type = HC_IBSS_START;
7412 priv->assoc_request.assoc_tsf_msw = 0;
7413 priv->assoc_request.assoc_tsf_lsw = 0;
7414 } else {
7415 if (unlikely(roaming))
7416 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7417 else
7418 priv->assoc_request.assoc_type = HC_ASSOCIATE;
Al Viro5b5e8072007-12-27 01:54:06 -05007419 priv->assoc_request.assoc_tsf_msw = cpu_to_le32(network->time_stamp[1]);
7420 priv->assoc_request.assoc_tsf_lsw = cpu_to_le32(network->time_stamp[0]);
James Ketrenos43f66a62005-03-25 12:31:53 -06007421 }
7422
James Ketrenosafbf30a2005-08-25 00:05:33 -05007423 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007424
7425 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7426 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
Al Viro5b5e8072007-12-27 01:54:06 -05007427 priv->assoc_request.atim_window = cpu_to_le16(network->atim_window);
James Ketrenos43f66a62005-03-25 12:31:53 -06007428 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007429 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007430 priv->assoc_request.atim_window = 0;
7431 }
7432
Al Viro5b5e8072007-12-27 01:54:06 -05007433 priv->assoc_request.listen_interval = cpu_to_le16(network->listen_interval);
Jeff Garzikbf794512005-07-31 13:07:26 -04007434
James Ketrenos43f66a62005-03-25 12:31:53 -06007435 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7436 if (err) {
7437 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7438 return err;
7439 }
7440
7441 rates->ieee_mode = priv->assoc_request.ieee_mode;
7442 rates->purpose = IPW_RATE_CONNECT;
7443 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007444
James Ketrenos43f66a62005-03-25 12:31:53 -06007445 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7446 priv->sys_config.dot11g_auto_detection = 1;
7447 else
7448 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007449
7450 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7451 priv->sys_config.answer_broadcast_ssid_probe = 1;
7452 else
7453 priv->sys_config.answer_broadcast_ssid_probe = 0;
7454
Zhu Yid685b8c2006-04-13 17:20:27 +08007455 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007456 if (err) {
7457 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7458 return err;
7459 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007460
James Ketrenos43f66a62005-03-25 12:31:53 -06007461 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007462 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007463 if (err) {
7464 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7465 return err;
7466 }
7467
7468 /*
7469 * If preemption is enabled, it is possible for the association
7470 * to complete before we return from ipw_send_associate. Therefore
7471 * we have to be sure and update our priviate data first.
7472 */
7473 priv->channel = network->channel;
7474 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007475 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007476 priv->status &= ~STATUS_SECURITY_UPDATED;
7477
7478 priv->assoc_network = network;
7479
Zhu Yie43e3c12006-04-13 17:20:45 +08007480#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007481 ipw_qos_association(priv, network);
7482#endif
7483
James Ketrenos43f66a62005-03-25 12:31:53 -06007484 err = ipw_send_associate(priv, &priv->assoc_request);
7485 if (err) {
7486 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7487 return err;
7488 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007489
Johannes Berge1749612008-10-27 15:59:26 -07007490 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04007491 print_ssid(ssid, priv->essid, priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07007492 priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007493
7494 return 0;
7495}
7496
7497static void ipw_roam(void *data)
7498{
7499 struct ipw_priv *priv = data;
7500 struct ieee80211_network *network = NULL;
7501 struct ipw_network_match match = {
7502 .network = priv->assoc_network
7503 };
7504
7505 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007506 *
7507 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007508 * setting the status ROAM bit and requesting a scan.
7509 * 2. When the scan completes, it schedules the ROAM work
7510 * 3. The ROAM work looks at all of the known networks for one that
7511 * is a better network than the currently associated. If none
7512 * found, the ROAM process is over (ROAM bit cleared)
7513 * 4. If a better network is found, a disassociation request is
7514 * sent.
7515 * 5. When the disassociation completes, the roam work is again
7516 * scheduled. The second time through, the driver is no longer
7517 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007518 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007519 * 6. At this point ,the roaming process is complete and the ROAM
7520 * status bit is cleared.
7521 */
7522
7523 /* If we are no longer associated, and the roaming bit is no longer
7524 * set, then we are not actively roaming, so just return */
7525 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7526 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007527
James Ketrenos43f66a62005-03-25 12:31:53 -06007528 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007529 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007530 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007531 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007532 u8 rssi = priv->assoc_network->stats.rssi;
7533 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007534 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007535 list_for_each_entry(network, &priv->ieee->network_list, list) {
7536 if (network != priv->assoc_network)
7537 ipw_best_network(priv, &match, network, 1);
7538 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007539 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007540 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007541
James Ketrenos43f66a62005-03-25 12:31:53 -06007542 if (match.network == priv->assoc_network) {
7543 IPW_DEBUG_ASSOC("No better APs in this network to "
7544 "roam to.\n");
7545 priv->status &= ~STATUS_ROAMING;
7546 ipw_debug_config(priv);
7547 return;
7548 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007549
James Ketrenos43f66a62005-03-25 12:31:53 -06007550 ipw_send_disassociate(priv, 1);
7551 priv->assoc_network = match.network;
7552
7553 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007554 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007555
7556 /* Second pass through ROAM process -- request association */
7557 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7558 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7559 priv->status &= ~STATUS_ROAMING;
7560}
7561
David Howellsc4028952006-11-22 14:57:56 +00007562static void ipw_bg_roam(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05007563{
David Howellsc4028952006-11-22 14:57:56 +00007564 struct ipw_priv *priv =
7565 container_of(work, struct ipw_priv, roam);
Zhu Yi46441512006-01-24 16:37:59 +08007566 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007567 ipw_roam(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007568 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007569}
7570
7571static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007572{
7573 struct ipw_priv *priv = data;
7574
7575 struct ieee80211_network *network = NULL;
7576 struct ipw_network_match match = {
7577 .network = NULL
7578 };
7579 struct ipw_supported_rates *rates;
7580 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007581 unsigned long flags;
John W. Linville9387b7c2008-09-30 20:59:05 -04007582 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007583
James Ketrenosb095c382005-08-24 22:04:42 -05007584 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7585 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7586 return 0;
7587 }
7588
James Ketrenosc848d0a2005-08-24 21:56:24 -05007589 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007590 IPW_DEBUG_ASSOC("Not attempting association (already in "
7591 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007592 return 0;
7593 }
7594
Hong Liue6324722005-09-14 21:04:15 -05007595 if (priv->status & STATUS_DISASSOCIATING) {
7596 IPW_DEBUG_ASSOC("Not attempting association (in "
7597 "disassociating)\n ");
7598 queue_work(priv->workqueue, &priv->associate);
7599 return 0;
7600 }
7601
James Ketrenosc848d0a2005-08-24 21:56:24 -05007602 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007603 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7604 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007605 return 0;
7606 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007607
7608 if (!(priv->config & CFG_ASSOCIATE) &&
Alexey Fisher3e4127f2008-11-06 09:51:16 +01007609 !(priv->config & (CFG_STATIC_ESSID | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007610 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007611 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007612 }
7613
James Ketrenosa613bff2005-08-24 21:43:11 -05007614 /* Protect our use of the network_list */
7615 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007616 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007617 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007618
7619 network = match.network;
7620 rates = &match.rates;
7621
7622 if (network == NULL &&
7623 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7624 priv->config & CFG_ADHOC_CREATE &&
7625 priv->config & CFG_STATIC_ESSID &&
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007626 priv->config & CFG_STATIC_CHANNEL) {
7627 /* Use oldest network if the free list is empty */
7628 if (list_empty(&priv->ieee->network_free_list)) {
7629 struct ieee80211_network *oldest = NULL;
7630 struct ieee80211_network *target;
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007631
7632 list_for_each_entry(target, &priv->ieee->network_list, list) {
7633 if ((oldest == NULL) ||
7634 (target->last_scanned < oldest->last_scanned))
7635 oldest = target;
7636 }
7637
7638 /* If there are no more slots, expire the oldest */
7639 list_del(&oldest->list);
7640 target = oldest;
Johannes Berge1749612008-10-27 15:59:26 -07007641 IPW_DEBUG_ASSOC("Expired '%s' (%pM) from "
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007642 "network list.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04007643 print_ssid(ssid, target->ssid,
7644 target->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07007645 target->bssid);
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007646 list_add_tail(&target->list,
7647 &priv->ieee->network_free_list);
7648 }
7649
James Ketrenos43f66a62005-03-25 12:31:53 -06007650 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007651 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007652 ipw_adhoc_create(priv, network);
7653 rates = &priv->rates;
7654 list_del(element);
7655 list_add_tail(&network->list, &priv->ieee->network_list);
7656 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007657 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007658
James Ketrenos43f66a62005-03-25 12:31:53 -06007659 /* If we reached the end of the list, then we don't have any valid
7660 * matching APs */
7661 if (!network) {
7662 ipw_debug_config(priv);
7663
James Ketrenosb095c382005-08-24 22:04:42 -05007664 if (!(priv->status & STATUS_SCANNING)) {
7665 if (!(priv->config & CFG_SPEED_SCAN))
7666 queue_delayed_work(priv->workqueue,
7667 &priv->request_scan,
7668 SCAN_INTERVAL);
7669 else
David Howellsc4028952006-11-22 14:57:56 +00007670 queue_delayed_work(priv->workqueue,
7671 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05007672 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007673
James Ketrenosc848d0a2005-08-24 21:56:24 -05007674 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007675 }
7676
7677 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007678
7679 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007680}
Jeff Garzikbf794512005-07-31 13:07:26 -04007681
David Howellsc4028952006-11-22 14:57:56 +00007682static void ipw_bg_associate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06007683{
David Howellsc4028952006-11-22 14:57:56 +00007684 struct ipw_priv *priv =
7685 container_of(work, struct ipw_priv, associate);
Zhu Yi46441512006-01-24 16:37:59 +08007686 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007687 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007688 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007689}
7690
James Ketrenosb095c382005-08-24 22:04:42 -05007691static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7692 struct sk_buff *skb)
7693{
7694 struct ieee80211_hdr *hdr;
7695 u16 fc;
7696
7697 hdr = (struct ieee80211_hdr *)skb->data;
John W. Linville72118012008-09-30 21:43:03 -04007698 fc = le16_to_cpu(hdr->frame_control);
James Ketrenosb095c382005-08-24 22:04:42 -05007699 if (!(fc & IEEE80211_FCTL_PROTECTED))
7700 return;
7701
7702 fc &= ~IEEE80211_FCTL_PROTECTED;
John W. Linville72118012008-09-30 21:43:03 -04007703 hdr->frame_control = cpu_to_le16(fc);
James Ketrenosb095c382005-08-24 22:04:42 -05007704 switch (priv->ieee->sec.level) {
7705 case SEC_LEVEL_3:
7706 /* Remove CCMP HDR */
7707 memmove(skb->data + IEEE80211_3ADDR_LEN,
7708 skb->data + IEEE80211_3ADDR_LEN + 8,
7709 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007710 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007711 break;
7712 case SEC_LEVEL_2:
7713 break;
7714 case SEC_LEVEL_1:
7715 /* Remove IV */
7716 memmove(skb->data + IEEE80211_3ADDR_LEN,
7717 skb->data + IEEE80211_3ADDR_LEN + 4,
7718 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007719 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007720 break;
7721 case SEC_LEVEL_0:
7722 break;
7723 default:
7724 printk(KERN_ERR "Unknow security level %d\n",
7725 priv->ieee->sec.level);
7726 break;
7727 }
7728}
7729
7730static void ipw_handle_data_packet(struct ipw_priv *priv,
7731 struct ipw_rx_mem_buffer *rxb,
7732 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007733{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007734 struct net_device *dev = priv->net_dev;
Hong Liu567deaf2005-08-31 18:07:22 +08007735 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007736 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7737
7738 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007739 dev->trans_start = jiffies;
James Ketrenos43f66a62005-03-25 12:31:53 -06007740
Jeff Garzikbf794512005-07-31 13:07:26 -04007741 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007742 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007743 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007744 skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007745 dev->stats.rx_errors++;
James Ketrenos43f66a62005-03-25 12:31:53 -06007746 priv->wstats.discard.misc++;
7747 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7748 return;
7749 } else if (unlikely(!netif_running(priv->net_dev))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007750 dev->stats.rx_dropped++;
James Ketrenos43f66a62005-03-25 12:31:53 -06007751 priv->wstats.discard.misc++;
7752 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7753 return;
7754 }
7755
7756 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007757 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007758
7759 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007760 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007761
7762 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7763
James Ketrenosb095c382005-08-24 22:04:42 -05007764 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007765 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7766 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007767 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007768 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007769 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7770
Jeff Garzikbf794512005-07-31 13:07:26 -04007771 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007772 dev->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007773 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007774 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007775 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007776 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007777}
7778
Zhu Yi459d4082006-04-13 17:21:00 +08007779#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007780static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7781 struct ipw_rx_mem_buffer *rxb,
7782 struct ieee80211_rx_stats *stats)
7783{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007784 struct net_device *dev = priv->net_dev;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007785 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7786 struct ipw_rx_frame *frame = &pkt->u.frame;
7787
7788 /* initial pull of some data */
7789 u16 received_channel = frame->received_channel;
7790 u8 antennaAndPhy = frame->antennaAndPhy;
7791 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7792 u16 pktrate = frame->rate;
7793
7794 /* Magic struct that slots into the radiotap header -- no reason
7795 * to build this manually element by element, we can write it much
7796 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007797 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007798
7799 short len = le16_to_cpu(pkt->u.frame.length);
7800
7801 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007802 dev->trans_start = jiffies;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007803
7804 /* We only process data packets if the
7805 * interface is open */
7806 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7807 skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007808 dev->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007809 priv->wstats.discard.misc++;
7810 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7811 return;
7812 } else if (unlikely(!netif_running(priv->net_dev))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007813 dev->stats.rx_dropped++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007814 priv->wstats.discard.misc++;
7815 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7816 return;
7817 }
7818
7819 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7820 * that now */
7821 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7822 /* FIXME: Should alloc bigger skb instead */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007823 dev->stats.rx_dropped++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007824 priv->wstats.discard.misc++;
7825 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7826 return;
7827 }
7828
7829 /* copy the frame itself */
7830 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7831 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7832
Mike Kershaw24a47db2005-08-26 00:41:54 -05007833 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7834
7835 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7836 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05007837 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(struct ipw_rt_hdr)); /* total header+data */
Mike Kershaw24a47db2005-08-26 00:41:54 -05007838
7839 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05007840 ipw_rt->rt_hdr.it_present = cpu_to_le32(
7841 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007842 (1 << IEEE80211_RADIOTAP_FLAGS) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007843 (1 << IEEE80211_RADIOTAP_RATE) |
7844 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7845 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007846 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007847 (1 << IEEE80211_RADIOTAP_ANTENNA));
7848
7849 /* Zero the flags, we'll add to them as we go */
7850 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007851 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7852 frame->parent_tsf[2] << 16 |
7853 frame->parent_tsf[1] << 8 |
7854 frame->parent_tsf[0]);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007855
7856 /* Convert signal to DBM */
7857 ipw_rt->rt_dbmsignal = antsignal;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007858 ipw_rt->rt_dbmnoise = frame->noise;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007859
7860 /* Convert the channel data and set the flags */
7861 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7862 if (received_channel > 14) { /* 802.11a */
7863 ipw_rt->rt_chbitmask =
7864 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7865 } else if (antennaAndPhy & 32) { /* 802.11b */
7866 ipw_rt->rt_chbitmask =
7867 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7868 } else { /* 802.11g */
7869 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05007870 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007871 }
7872
7873 /* set the rate in multiples of 500k/s */
7874 switch (pktrate) {
7875 case IPW_TX_RATE_1MB:
7876 ipw_rt->rt_rate = 2;
7877 break;
7878 case IPW_TX_RATE_2MB:
7879 ipw_rt->rt_rate = 4;
7880 break;
7881 case IPW_TX_RATE_5MB:
7882 ipw_rt->rt_rate = 10;
7883 break;
7884 case IPW_TX_RATE_6MB:
7885 ipw_rt->rt_rate = 12;
7886 break;
7887 case IPW_TX_RATE_9MB:
7888 ipw_rt->rt_rate = 18;
7889 break;
7890 case IPW_TX_RATE_11MB:
7891 ipw_rt->rt_rate = 22;
7892 break;
7893 case IPW_TX_RATE_12MB:
7894 ipw_rt->rt_rate = 24;
7895 break;
7896 case IPW_TX_RATE_18MB:
7897 ipw_rt->rt_rate = 36;
7898 break;
7899 case IPW_TX_RATE_24MB:
7900 ipw_rt->rt_rate = 48;
7901 break;
7902 case IPW_TX_RATE_36MB:
7903 ipw_rt->rt_rate = 72;
7904 break;
7905 case IPW_TX_RATE_48MB:
7906 ipw_rt->rt_rate = 96;
7907 break;
7908 case IPW_TX_RATE_54MB:
7909 ipw_rt->rt_rate = 108;
7910 break;
7911 default:
7912 ipw_rt->rt_rate = 0;
7913 break;
7914 }
7915
7916 /* antenna number */
7917 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7918
7919 /* set the preamble flag if we have it */
7920 if ((antennaAndPhy & 64))
7921 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7922
7923 /* Set the size of the skb to the size of the frame */
7924 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007925
7926 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7927
7928 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007929 dev->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007930 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007931 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007932 /* no LED during capture */
7933 }
7934}
7935#endif
7936
Zhu Yid685b8c2006-04-13 17:20:27 +08007937#ifdef CONFIG_IPW2200_PROMISCUOUS
7938#define ieee80211_is_probe_response(fc) \
7939 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7940 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7941
7942#define ieee80211_is_management(fc) \
7943 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7944
7945#define ieee80211_is_control(fc) \
7946 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7947
7948#define ieee80211_is_data(fc) \
7949 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7950
7951#define ieee80211_is_assoc_request(fc) \
7952 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7953
7954#define ieee80211_is_reassoc_request(fc) \
7955 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7956
7957static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7958 struct ipw_rx_mem_buffer *rxb,
7959 struct ieee80211_rx_stats *stats)
7960{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007961 struct net_device *dev = priv->prom_net_dev;
Zhu Yid685b8c2006-04-13 17:20:27 +08007962 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7963 struct ipw_rx_frame *frame = &pkt->u.frame;
7964 struct ipw_rt_hdr *ipw_rt;
7965
7966 /* First cache any information we need before we overwrite
7967 * the information provided in the skb from the hardware */
7968 struct ieee80211_hdr *hdr;
7969 u16 channel = frame->received_channel;
7970 u8 phy_flags = frame->antennaAndPhy;
7971 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7972 s8 noise = frame->noise;
7973 u8 rate = frame->rate;
7974 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007975 struct sk_buff *skb;
7976 int hdr_only = 0;
7977 u16 filter = priv->prom_priv->filter;
7978
7979 /* If the filter is set to not include Rx frames then return */
7980 if (filter & IPW_PROM_NO_RX)
7981 return;
7982
Zhu Yid685b8c2006-04-13 17:20:27 +08007983 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007984 dev->trans_start = jiffies;
Zhu Yid685b8c2006-04-13 17:20:27 +08007985
7986 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007987 dev->stats.rx_errors++;
Zhu Yid685b8c2006-04-13 17:20:27 +08007988 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7989 return;
7990 }
7991
7992 /* We only process data packets if the interface is open */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007993 if (unlikely(!netif_running(dev))) {
7994 dev->stats.rx_dropped++;
Zhu Yid685b8c2006-04-13 17:20:27 +08007995 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7996 return;
7997 }
7998
7999 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
8000 * that now */
8001 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
8002 /* FIXME: Should alloc bigger skb instead */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00008003 dev->stats.rx_dropped++;
Zhu Yid685b8c2006-04-13 17:20:27 +08008004 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
8005 return;
8006 }
8007
8008 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
John W. Linville72118012008-09-30 21:43:03 -04008009 if (ieee80211_is_management(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008010 if (filter & IPW_PROM_NO_MGMT)
8011 return;
8012 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
8013 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -04008014 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008015 if (filter & IPW_PROM_NO_CTL)
8016 return;
8017 if (filter & IPW_PROM_CTL_HEADER_ONLY)
8018 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -04008019 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008020 if (filter & IPW_PROM_NO_DATA)
8021 return;
8022 if (filter & IPW_PROM_DATA_HEADER_ONLY)
8023 hdr_only = 1;
8024 }
8025
8026 /* Copy the SKB since this is for the promiscuous side */
8027 skb = skb_copy(rxb->skb, GFP_ATOMIC);
8028 if (skb == NULL) {
8029 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
8030 return;
8031 }
8032
8033 /* copy the frame data to write after where the radiotap header goes */
8034 ipw_rt = (void *)skb->data;
8035
8036 if (hdr_only)
John W. Linville72118012008-09-30 21:43:03 -04008037 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_control));
Zhu Yid685b8c2006-04-13 17:20:27 +08008038
8039 memcpy(ipw_rt->payload, hdr, len);
8040
Zhu Yid685b8c2006-04-13 17:20:27 +08008041 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
8042 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05008043 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(*ipw_rt)); /* total header+data */
Zhu Yid685b8c2006-04-13 17:20:27 +08008044
8045 /* Set the size of the skb to the size of the frame */
Al Viro743b84d2007-12-27 01:43:16 -05008046 skb_put(skb, sizeof(*ipw_rt) + len);
Zhu Yid685b8c2006-04-13 17:20:27 +08008047
8048 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05008049 ipw_rt->rt_hdr.it_present = cpu_to_le32(
8050 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08008051 (1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08008052 (1 << IEEE80211_RADIOTAP_RATE) |
8053 (1 << IEEE80211_RADIOTAP_CHANNEL) |
8054 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
8055 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
8056 (1 << IEEE80211_RADIOTAP_ANTENNA));
8057
8058 /* Zero the flags, we'll add to them as we go */
8059 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08008060 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
8061 frame->parent_tsf[2] << 16 |
8062 frame->parent_tsf[1] << 8 |
8063 frame->parent_tsf[0]);
Zhu Yid685b8c2006-04-13 17:20:27 +08008064
8065 /* Convert to DBM */
8066 ipw_rt->rt_dbmsignal = signal;
8067 ipw_rt->rt_dbmnoise = noise;
8068
8069 /* Convert the channel data and set the flags */
8070 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
8071 if (channel > 14) { /* 802.11a */
8072 ipw_rt->rt_chbitmask =
8073 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
8074 } else if (phy_flags & (1 << 5)) { /* 802.11b */
8075 ipw_rt->rt_chbitmask =
8076 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
8077 } else { /* 802.11g */
8078 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05008079 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Zhu Yid685b8c2006-04-13 17:20:27 +08008080 }
8081
8082 /* set the rate in multiples of 500k/s */
8083 switch (rate) {
8084 case IPW_TX_RATE_1MB:
8085 ipw_rt->rt_rate = 2;
8086 break;
8087 case IPW_TX_RATE_2MB:
8088 ipw_rt->rt_rate = 4;
8089 break;
8090 case IPW_TX_RATE_5MB:
8091 ipw_rt->rt_rate = 10;
8092 break;
8093 case IPW_TX_RATE_6MB:
8094 ipw_rt->rt_rate = 12;
8095 break;
8096 case IPW_TX_RATE_9MB:
8097 ipw_rt->rt_rate = 18;
8098 break;
8099 case IPW_TX_RATE_11MB:
8100 ipw_rt->rt_rate = 22;
8101 break;
8102 case IPW_TX_RATE_12MB:
8103 ipw_rt->rt_rate = 24;
8104 break;
8105 case IPW_TX_RATE_18MB:
8106 ipw_rt->rt_rate = 36;
8107 break;
8108 case IPW_TX_RATE_24MB:
8109 ipw_rt->rt_rate = 48;
8110 break;
8111 case IPW_TX_RATE_36MB:
8112 ipw_rt->rt_rate = 72;
8113 break;
8114 case IPW_TX_RATE_48MB:
8115 ipw_rt->rt_rate = 96;
8116 break;
8117 case IPW_TX_RATE_54MB:
8118 ipw_rt->rt_rate = 108;
8119 break;
8120 default:
8121 ipw_rt->rt_rate = 0;
8122 break;
8123 }
8124
8125 /* antenna number */
8126 ipw_rt->rt_antenna = (phy_flags & 3);
8127
8128 /* set the preamble flag if we have it */
8129 if (phy_flags & (1 << 6))
8130 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
8131
8132 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
8133
8134 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00008135 dev->stats.rx_errors++;
Zhu Yid685b8c2006-04-13 17:20:27 +08008136 dev_kfree_skb_any(skb);
8137 }
8138}
8139#endif
8140
Arjan van de Ven858119e2006-01-14 13:20:43 -08008141static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05008142 struct ieee80211_hdr_4addr *header)
8143{
8144 /* Filter incoming packets to determine if they are targetted toward
8145 * this network, discarding packets coming from ourselves */
8146 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05008147 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008148 /* packets from our adapter are dropped (echo) */
8149 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
8150 return 0;
8151
Peter Jones90700fd2005-08-26 16:51:06 -05008152 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008153 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05008154 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008155
8156 /* packets to our adapter go through */
8157 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8158 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008159
Peter Jones90700fd2005-08-26 16:51:06 -05008160 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008161 /* packets from our adapter are dropped (echo) */
8162 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
8163 return 0;
8164
Peter Jones90700fd2005-08-26 16:51:06 -05008165 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008166 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05008167 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
8168
8169 /* packets to our adapter go through */
8170 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8171 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05008172 }
James Ketrenosa613bff2005-08-24 21:43:11 -05008173
James Ketrenosea2b26e2005-08-24 21:25:16 -05008174 return 1;
8175}
8176
James Ketrenosafbf30a2005-08-25 00:05:33 -05008177#define IPW_PACKET_RETRY_TIME HZ
8178
Arjan van de Ven858119e2006-01-14 13:20:43 -08008179static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05008180 struct ieee80211_hdr_4addr *header)
8181{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008182 u16 sc = le16_to_cpu(header->seq_ctl);
8183 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8184 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8185 u16 *last_seq, *last_frag;
8186 unsigned long *last_time;
8187
8188 switch (priv->ieee->iw_mode) {
8189 case IW_MODE_ADHOC:
8190 {
8191 struct list_head *p;
8192 struct ipw_ibss_seq *entry = NULL;
8193 u8 *mac = header->addr2;
8194 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8195
8196 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8197 entry =
8198 list_entry(p, struct ipw_ibss_seq, list);
8199 if (!memcmp(entry->mac, mac, ETH_ALEN))
8200 break;
8201 }
8202 if (p == &priv->ibss_mac_hash[index]) {
8203 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8204 if (!entry) {
8205 IPW_ERROR
8206 ("Cannot malloc new mac entry\n");
8207 return 0;
8208 }
8209 memcpy(entry->mac, mac, ETH_ALEN);
8210 entry->seq_num = seq;
8211 entry->frag_num = frag;
8212 entry->packet_time = jiffies;
8213 list_add(&entry->list,
8214 &priv->ibss_mac_hash[index]);
8215 return 0;
8216 }
8217 last_seq = &entry->seq_num;
8218 last_frag = &entry->frag_num;
8219 last_time = &entry->packet_time;
8220 break;
8221 }
8222 case IW_MODE_INFRA:
8223 last_seq = &priv->last_seq_num;
8224 last_frag = &priv->last_frag_num;
8225 last_time = &priv->last_packet_time;
8226 break;
8227 default:
8228 return 0;
8229 }
8230 if ((*last_seq == seq) &&
8231 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8232 if (*last_frag == frag)
8233 goto drop;
8234 if (*last_frag + 1 != frag)
8235 /* out-of-order fragment */
8236 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008237 } else
8238 *last_seq = seq;
8239
Zhu Yif57ce7c2005-07-13 12:22:15 -05008240 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008241 *last_time = jiffies;
8242 return 0;
8243
8244 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008245 /* Comment this line now since we observed the card receives
8246 * duplicate packets but the FCTL_RETRY bit is not set in the
8247 * IBSS mode with fragmentation enabled.
John W. Linville72118012008-09-30 21:43:03 -04008248 BUG_ON(!(le16_to_cpu(header->frame_control) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008249 return 1;
8250}
8251
James Ketrenosb095c382005-08-24 22:04:42 -05008252static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8253 struct ipw_rx_mem_buffer *rxb,
8254 struct ieee80211_rx_stats *stats)
8255{
8256 struct sk_buff *skb = rxb->skb;
8257 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8258 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8259 (skb->data + IPW_RX_FRAME_SIZE);
8260
8261 ieee80211_rx_mgt(priv->ieee, header, stats);
8262
8263 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8264 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8265 IEEE80211_STYPE_PROBE_RESP) ||
8266 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8267 IEEE80211_STYPE_BEACON))) {
8268 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8269 ipw_add_station(priv, header->addr2);
8270 }
8271
8272 if (priv->config & CFG_NET_STATS) {
8273 IPW_DEBUG_HC("sending stat packet\n");
8274
8275 /* Set the size of the skb to the size of the full
8276 * ipw header and 802.11 frame */
8277 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8278 IPW_RX_FRAME_SIZE);
8279
8280 /* Advance past the ipw packet header to the 802.11 frame */
8281 skb_pull(skb, IPW_RX_FRAME_SIZE);
8282
8283 /* Push the ieee80211_rx_stats before the 802.11 frame */
8284 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8285
8286 skb->dev = priv->ieee->dev;
8287
8288 /* Point raw at the ieee80211_stats */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07008289 skb_reset_mac_header(skb);
James Ketrenosb095c382005-08-24 22:04:42 -05008290
8291 skb->pkt_type = PACKET_OTHERHOST;
Harvey Harrisonc1b4aa32009-01-29 13:26:44 -08008292 skb->protocol = cpu_to_be16(ETH_P_80211_STATS);
James Ketrenosb095c382005-08-24 22:04:42 -05008293 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8294 netif_rx(skb);
8295 rxb->skb = NULL;
8296 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008297}
8298
James Ketrenos43f66a62005-03-25 12:31:53 -06008299/*
8300 * Main entry function for recieving a packet with 80211 headers. This
8301 * should be called when ever the FW has notified us that there is a new
8302 * skb in the recieve queue.
8303 */
8304static void ipw_rx(struct ipw_priv *priv)
8305{
8306 struct ipw_rx_mem_buffer *rxb;
8307 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008308 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008309 u32 r, w, i;
8310 u8 network_packet;
Dan Williams943dbef2008-02-14 17:49:41 -05008311 u8 fill_rx = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008312
James Ketrenosb095c382005-08-24 22:04:42 -05008313 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8314 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
Dan Williams943dbef2008-02-14 17:49:41 -05008315 i = priv->rxq->read;
8316
8317 if (ipw_rx_queue_space (priv->rxq) > (RX_QUEUE_SIZE / 2))
8318 fill_rx = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008319
8320 while (i != r) {
8321 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008322 if (unlikely(rxb == NULL)) {
8323 printk(KERN_CRIT "Queue not allocated!\n");
8324 break;
8325 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008326 priv->rxq->queue[i] = NULL;
8327
8328 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008329 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008330 PCI_DMA_FROMDEVICE);
8331
8332 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8333 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8334 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008335 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008336
8337 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008338 case RX_FRAME_TYPE: /* 802.11 frame */ {
8339 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008340 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008341 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008342 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008343 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8344 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008345 .noise =
8346 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008347 .rate = pkt->u.frame.rate,
8348 .mac_time = jiffies,
8349 .received_channel =
8350 pkt->u.frame.received_channel,
8351 .freq =
8352 (pkt->u.frame.
8353 control & (1 << 0)) ?
8354 IEEE80211_24GHZ_BAND :
8355 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008356 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008357 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008358
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008359 if (stats.rssi != 0)
8360 stats.mask |= IEEE80211_STATMASK_RSSI;
8361 if (stats.signal != 0)
8362 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008363 if (stats.noise != 0)
8364 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008365 if (stats.rate != 0)
8366 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008367
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008368 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008369
Zhu Yid685b8c2006-04-13 17:20:27 +08008370#ifdef CONFIG_IPW2200_PROMISCUOUS
8371 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8372 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8373#endif
8374
James Ketrenosb095c382005-08-24 22:04:42 -05008375#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008376 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008377#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008378
8379 ipw_handle_data_packet_monitor(priv,
8380 rxb,
8381 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008382#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008383 ipw_handle_data_packet(priv, rxb,
8384 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008385#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008386 break;
8387 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008388#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008389
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008390 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008391 (struct ieee80211_hdr_4addr *)(rxb->skb->
8392 data +
8393 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008394 /* TODO: Check Ad-Hoc dest/source and make sure
8395 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008396 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008397 * frame control of the packet and disregard
8398 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008399
James Ketrenosea2b26e2005-08-24 21:25:16 -05008400 network_packet =
8401 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008402 if (network_packet && priv->assoc_network) {
8403 priv->assoc_network->stats.rssi =
8404 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008405 priv->exp_avg_rssi =
8406 exponential_average(priv->exp_avg_rssi,
8407 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008408 }
8409
8410 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008411 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008412
James Ketrenosa613bff2005-08-24 21:43:11 -05008413 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008414 ieee80211_get_hdrlen(le16_to_cpu(
8415 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008416 IPW_DEBUG_DROP
8417 ("Received packet is too small. "
8418 "Dropping.\n");
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00008419 priv->net_dev->stats.rx_errors++;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008420 priv->wstats.discard.misc++;
8421 break;
8422 }
8423
James Ketrenosa613bff2005-08-24 21:43:11 -05008424 switch (WLAN_FC_GET_TYPE
8425 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008426
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008427 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008428 ipw_handle_mgmt_packet(priv, rxb,
8429 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008430 break;
8431
8432 case IEEE80211_FTYPE_CTL:
8433 break;
8434
8435 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008436 if (unlikely(!network_packet ||
8437 is_duplicate_packet(priv,
8438 header)))
8439 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008440 IPW_DEBUG_DROP("Dropping: "
Johannes Berge1749612008-10-27 15:59:26 -07008441 "%pM, "
8442 "%pM, "
8443 "%pM\n",
8444 header->addr1,
8445 header->addr2,
8446 header->addr3);
James Ketrenosb095c382005-08-24 22:04:42 -05008447 break;
8448 }
8449
8450 ipw_handle_data_packet(priv, rxb,
8451 &stats);
8452
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008453 break;
8454 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008455 break;
8456 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008457
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008458 case RX_HOST_NOTIFICATION_TYPE:{
8459 IPW_DEBUG_RX
8460 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008461 pkt->u.notification.subtype,
8462 pkt->u.notification.flags,
Zhu Yi720eeb42006-12-05 14:41:40 +08008463 le16_to_cpu(pkt->u.notification.size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008464 ipw_rx_notification(priv, &pkt->u.notification);
8465 break;
8466 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008467
8468 default:
8469 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8470 pkt->header.message_type);
8471 break;
8472 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008473
8474 /* For now we just don't re-use anything. We can tweak this
8475 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008476 * fail to Rx correctly */
8477 if (rxb->skb != NULL) {
8478 dev_kfree_skb_any(rxb->skb);
8479 rxb->skb = NULL;
8480 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008481
James Ketrenos43f66a62005-03-25 12:31:53 -06008482 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008483 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008484 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008485
James Ketrenos43f66a62005-03-25 12:31:53 -06008486 i = (i + 1) % RX_QUEUE_SIZE;
Dan Williams943dbef2008-02-14 17:49:41 -05008487
8488 /* If there are a lot of unsued frames, restock the Rx queue
8489 * so the ucode won't assert */
8490 if (fill_rx) {
8491 priv->rxq->read = i;
8492 ipw_rx_queue_replenish(priv);
8493 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008494 }
8495
8496 /* Backtrack one entry */
Dan Williams943dbef2008-02-14 17:49:41 -05008497 priv->rxq->read = i;
James Ketrenos43f66a62005-03-25 12:31:53 -06008498 ipw_rx_queue_restock(priv);
8499}
8500
James Ketrenosafbf30a2005-08-25 00:05:33 -05008501#define DEFAULT_RTS_THRESHOLD 2304U
8502#define MIN_RTS_THRESHOLD 1U
8503#define MAX_RTS_THRESHOLD 2304U
8504#define DEFAULT_BEACON_INTERVAL 100U
8505#define DEFAULT_SHORT_RETRY_LIMIT 7U
8506#define DEFAULT_LONG_RETRY_LIMIT 4U
8507
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008508/**
8509 * ipw_sw_reset
8510 * @option: options to control different reset behaviour
8511 * 0 = reset everything except the 'disable' module_param
8512 * 1 = reset everything and print out driver info (for probe only)
8513 * 2 = reset everything
8514 */
8515static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008516{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008517 int band, modulation;
8518 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008519
James Ketrenosafbf30a2005-08-25 00:05:33 -05008520 /* Initialize module parameter values here */
8521 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008522
James Ketrenosafbf30a2005-08-25 00:05:33 -05008523 /* We default to disabling the LED code as right now it causes
8524 * too many systems to lock up... */
8525 if (!led)
8526 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008527
James Ketrenosafbf30a2005-08-25 00:05:33 -05008528 if (associate)
8529 priv->config |= CFG_ASSOCIATE;
8530 else
8531 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008532
James Ketrenosafbf30a2005-08-25 00:05:33 -05008533 if (auto_create)
8534 priv->config |= CFG_ADHOC_CREATE;
8535 else
8536 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8537
Zhu Yi17ed0812006-01-24 16:36:31 +08008538 priv->config &= ~CFG_STATIC_ESSID;
8539 priv->essid_len = 0;
8540 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8541
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008542 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008543 priv->status |= STATUS_RF_KILL_SW;
8544 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008545 }
8546
James Ketrenosafbf30a2005-08-25 00:05:33 -05008547 if (channel != 0) {
8548 priv->config |= CFG_STATIC_CHANNEL;
8549 priv->channel = channel;
8550 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8551 /* TODO: Validate that provided channel is in range */
8552 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008553#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008554 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8555 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008556#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008557
8558 switch (mode) {
8559 case 1:
8560 priv->ieee->iw_mode = IW_MODE_ADHOC;
8561 priv->net_dev->type = ARPHRD_ETHER;
8562
8563 break;
8564#ifdef CONFIG_IPW2200_MONITOR
8565 case 2:
8566 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008567#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008568 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8569#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008570 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008571#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008572 break;
8573#endif
8574 default:
8575 case 0:
8576 priv->net_dev->type = ARPHRD_ETHER;
8577 priv->ieee->iw_mode = IW_MODE_INFRA;
8578 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008579 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008580
James Ketrenosafbf30a2005-08-25 00:05:33 -05008581 if (hwcrypto) {
8582 priv->ieee->host_encrypt = 0;
8583 priv->ieee->host_encrypt_msdu = 0;
8584 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008585 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008586 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008587 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008588
Zhu Yie402c932005-08-05 17:20:40 +08008589 /* IPW2200/2915 is abled to do hardware fragmentation. */
8590 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008591
James Ketrenosafbf30a2005-08-25 00:05:33 -05008592 if ((priv->pci_dev->device == 0x4223) ||
8593 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008594 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008595 printk(KERN_INFO DRV_NAME
8596 ": Detected Intel PRO/Wireless 2915ABG Network "
8597 "Connection\n");
8598 priv->ieee->abg_true = 1;
8599 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8600 modulation = IEEE80211_OFDM_MODULATION |
8601 IEEE80211_CCK_MODULATION;
8602 priv->adapter = IPW_2915ABG;
8603 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008604 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008605 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008606 printk(KERN_INFO DRV_NAME
8607 ": Detected Intel PRO/Wireless 2200BG Network "
8608 "Connection\n");
8609
8610 priv->ieee->abg_true = 0;
8611 band = IEEE80211_24GHZ_BAND;
8612 modulation = IEEE80211_OFDM_MODULATION |
8613 IEEE80211_CCK_MODULATION;
8614 priv->adapter = IPW_2200BG;
8615 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008616 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008617
James Ketrenosafbf30a2005-08-25 00:05:33 -05008618 priv->ieee->freq_band = band;
8619 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008620
James Ketrenosafbf30a2005-08-25 00:05:33 -05008621 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008622
James Ketrenosafbf30a2005-08-25 00:05:33 -05008623 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8624 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008625
James Ketrenosafbf30a2005-08-25 00:05:33 -05008626 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8627 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8628 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008629
James Ketrenosafbf30a2005-08-25 00:05:33 -05008630 /* If power management is turned on, default to AC mode */
8631 priv->power_mode = IPW_POWER_AC;
8632 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008633
Zhu Yi0ece35b2005-08-05 17:26:51 +08008634 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008635}
8636
8637/*
8638 * This file defines the Wireless Extension handlers. It does not
8639 * define any methods of hardware manipulation and relies on the
8640 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008641 *
8642 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008643 * function used to poll the hardware vs. making unecessary calls.
8644 *
8645 */
8646
Jeff Garzikbf794512005-07-31 13:07:26 -04008647static int ipw_wx_get_name(struct net_device *dev,
8648 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008649 union iwreq_data *wrqu, char *extra)
8650{
8651 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008652 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008653 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008654 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008655 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008656 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008657 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008658 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8659 ipw_modes[priv->assoc_request.ieee_mode]);
8660 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008661 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008662 return 0;
8663}
8664
8665static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8666{
8667 if (channel == 0) {
8668 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8669 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008670 IPW_DEBUG_ASSOC("Attempting to associate with new "
8671 "parameters.\n");
8672 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008673 return 0;
8674 }
8675
8676 priv->config |= CFG_STATIC_CHANNEL;
8677
8678 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008679 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8680 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008681 return 0;
8682 }
8683
8684 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8685 priv->channel = channel;
8686
James Ketrenosb095c382005-08-24 22:04:42 -05008687#ifdef CONFIG_IPW2200_MONITOR
8688 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008689 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008690 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008691 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008692 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008693 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008694 }
8695
8696 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8697 udelay(10);
8698
8699 if (priv->status & STATUS_SCANNING)
8700 IPW_DEBUG_SCAN("Still scanning...\n");
8701 else
8702 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8703 1000 - i);
8704
8705 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008706 }
James Ketrenosb095c382005-08-24 22:04:42 -05008707#endif /* CONFIG_IPW2200_MONITOR */
8708
James Ketrenosc848d0a2005-08-24 21:56:24 -05008709 /* Network configuration changed -- force [re]association */
8710 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8711 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008712 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008713
8714 return 0;
8715}
8716
Jeff Garzikbf794512005-07-31 13:07:26 -04008717static int ipw_wx_set_freq(struct net_device *dev,
8718 struct iw_request_info *info,
8719 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008720{
8721 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008722 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008723 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008724 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008725 u8 channel, flags;
8726 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008727
James Ketrenosb095c382005-08-24 22:04:42 -05008728 if (fwrq->m == 0) {
8729 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008730 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008731 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008732 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008733 return ret;
8734 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008735 /* if setting by freq convert to channel */
8736 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008737 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008738 if (channel == 0)
8739 return -EINVAL;
8740 } else
8741 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008742
Larry Finger1867b112006-02-28 09:48:28 -06008743 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008744 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008745
Liu Hong1fe0adb2005-08-19 09:33:10 -05008746 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008747 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008748 if (i == -1)
8749 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008750
8751 flags = (band == IEEE80211_24GHZ_BAND) ?
8752 geo->bg[i].flags : geo->a[i].flags;
8753 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008754 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8755 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008756 }
8757 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008758
James Ketrenos43f66a62005-03-25 12:31:53 -06008759 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008760 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008761 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008762 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008763 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008764}
8765
Jeff Garzikbf794512005-07-31 13:07:26 -04008766static int ipw_wx_get_freq(struct net_device *dev,
8767 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008768 union iwreq_data *wrqu, char *extra)
8769{
8770 struct ipw_priv *priv = ieee80211_priv(dev);
8771
8772 wrqu->freq.e = 0;
8773
8774 /* If we are associated, trying to associate, or have a statically
8775 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008776 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008777 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008778 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8779 int i;
8780
8781 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8782 BUG_ON(i == -1);
8783 wrqu->freq.e = 1;
8784
8785 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8786 case IEEE80211_52GHZ_BAND:
8787 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8788 break;
8789
8790 case IEEE80211_24GHZ_BAND:
8791 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8792 break;
8793
8794 default:
8795 BUG();
8796 }
8797 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008798 wrqu->freq.m = 0;
8799
Zhu Yi46441512006-01-24 16:37:59 +08008800 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008801 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8802 return 0;
8803}
8804
Jeff Garzikbf794512005-07-31 13:07:26 -04008805static int ipw_wx_set_mode(struct net_device *dev,
8806 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008807 union iwreq_data *wrqu, char *extra)
8808{
8809 struct ipw_priv *priv = ieee80211_priv(dev);
8810 int err = 0;
8811
8812 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8813
James Ketrenos43f66a62005-03-25 12:31:53 -06008814 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008815#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008816 case IW_MODE_MONITOR:
8817#endif
8818 case IW_MODE_ADHOC:
8819 case IW_MODE_INFRA:
8820 break;
8821 case IW_MODE_AUTO:
8822 wrqu->mode = IW_MODE_INFRA;
8823 break;
8824 default:
8825 return -EINVAL;
8826 }
James Ketrenosb095c382005-08-24 22:04:42 -05008827 if (wrqu->mode == priv->ieee->iw_mode)
8828 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008829
Zhu Yi46441512006-01-24 16:37:59 +08008830 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008831
8832 ipw_sw_reset(priv, 0);
8833
James Ketrenosb095c382005-08-24 22:04:42 -05008834#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008835 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008836 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008837
8838 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008839#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008840 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8841#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008842 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008843#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008844#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008845
Jeff Garzikbf794512005-07-31 13:07:26 -04008846 /* Free the existing firmware and reset the fw_loaded
Nick Andrew877d0312009-01-26 11:06:57 +01008847 * flag so ipw_load() will bring in the new firmware */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008848 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008849
8850 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008851
James Ketrenosc848d0a2005-08-24 21:56:24 -05008852 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008853 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008854 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008855}
8856
Jeff Garzikbf794512005-07-31 13:07:26 -04008857static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008858 struct iw_request_info *info,
8859 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008860{
8861 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008862 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008863 wrqu->mode = priv->ieee->iw_mode;
8864 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008865 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008866 return 0;
8867}
8868
James Ketrenos43f66a62005-03-25 12:31:53 -06008869/* Values are in microsecond */
8870static const s32 timeout_duration[] = {
8871 350000,
8872 250000,
8873 75000,
8874 37000,
8875 25000,
8876};
8877
8878static const s32 period_duration[] = {
8879 400000,
8880 700000,
8881 1000000,
8882 1000000,
8883 1000000
8884};
8885
Jeff Garzikbf794512005-07-31 13:07:26 -04008886static int ipw_wx_get_range(struct net_device *dev,
8887 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008888 union iwreq_data *wrqu, char *extra)
8889{
8890 struct ipw_priv *priv = ieee80211_priv(dev);
8891 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008892 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008893 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008894
8895 wrqu->data.length = sizeof(*range);
8896 memset(range, 0, sizeof(*range));
8897
8898 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008899 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008900
8901 range->max_qual.qual = 100;
8902 /* TODO: Find real max RSSI and stick here */
8903 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008904 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008905 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008906
8907 range->avg_qual.qual = 70;
8908 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008909 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008910 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008911 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008912 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008913 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008914
Jeff Garzikbf794512005-07-31 13:07:26 -04008915 for (i = 0; i < range->num_bitrates; i++)
8916 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008917 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008918
James Ketrenos43f66a62005-03-25 12:31:53 -06008919 range->max_rts = DEFAULT_RTS_THRESHOLD;
8920 range->min_frag = MIN_FRAG_THRESHOLD;
8921 range->max_frag = MAX_FRAG_THRESHOLD;
8922
8923 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008924 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008925 range->num_encoding_sizes = 2;
8926 range->max_encoding_tokens = WEP_KEYS;
8927
8928 /* Set the Wireless Extension versions */
8929 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008930 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008931
James Ketrenosb095c382005-08-24 22:04:42 -05008932 i = 0;
8933 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008934 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8935 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8936 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8937 continue;
8938
James Ketrenosb095c382005-08-24 22:04:42 -05008939 range->freq[i].i = geo->bg[j].channel;
8940 range->freq[i].m = geo->bg[j].freq * 100000;
8941 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008942 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008943 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008944 }
James Ketrenosb095c382005-08-24 22:04:42 -05008945
8946 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008947 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8948 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8949 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8950 continue;
8951
James Ketrenosb095c382005-08-24 22:04:42 -05008952 range->freq[i].i = geo->a[j].channel;
8953 range->freq[i].m = geo->a[j].freq * 100000;
8954 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008955 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008956 }
8957 }
8958
8959 range->num_channels = i;
8960 range->num_frequency = i;
8961
Zhu Yi46441512006-01-24 16:37:59 +08008962 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008963
8964 /* Event capability (kernel + driver) */
8965 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8966 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008967 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8968 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008969 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008970
Dan Williamsf1b50862006-01-30 13:58:56 -05008971 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8972 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8973
Dan Williams374fdfb2007-12-12 10:25:07 -05008974 range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE;
8975
James Ketrenos43f66a62005-03-25 12:31:53 -06008976 IPW_DEBUG_WX("GET Range\n");
8977 return 0;
8978}
8979
Jeff Garzikbf794512005-07-31 13:07:26 -04008980static int ipw_wx_set_wap(struct net_device *dev,
8981 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008982 union iwreq_data *wrqu, char *extra)
8983{
8984 struct ipw_priv *priv = ieee80211_priv(dev);
8985
8986 static const unsigned char any[] = {
8987 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8988 };
8989 static const unsigned char off[] = {
8990 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8991 };
8992
Jeff Garzikbf794512005-07-31 13:07:26 -04008993 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008994 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008995 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008996 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8997 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8998 /* we disable mandatory BSSID association */
8999 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
9000 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009001 IPW_DEBUG_ASSOC("Attempting to associate with new "
9002 "parameters.\n");
9003 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08009004 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009005 return 0;
9006 }
9007
9008 priv->config |= CFG_STATIC_BSSID;
9009 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
9010 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009011 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009012 return 0;
9013 }
9014
Johannes Berge1749612008-10-27 15:59:26 -07009015 IPW_DEBUG_WX("Setting mandatory BSSID to %pM\n",
9016 wrqu->ap_addr.sa_data);
James Ketrenos43f66a62005-03-25 12:31:53 -06009017
9018 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
9019
James Ketrenosc848d0a2005-08-24 21:56:24 -05009020 /* Network configuration changed -- force [re]association */
9021 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
9022 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009023 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009024
Zhu Yi46441512006-01-24 16:37:59 +08009025 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009026 return 0;
9027}
9028
Jeff Garzikbf794512005-07-31 13:07:26 -04009029static int ipw_wx_get_wap(struct net_device *dev,
9030 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009031 union iwreq_data *wrqu, char *extra)
9032{
9033 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07009034
James Ketrenos43f66a62005-03-25 12:31:53 -06009035 /* If we are associated, trying to associate, or have a statically
9036 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009037 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009038 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06009039 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9040 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009041 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06009042 } else
9043 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
9044
Johannes Berge1749612008-10-27 15:59:26 -07009045 IPW_DEBUG_WX("Getting WAP BSSID: %pM\n",
9046 wrqu->ap_addr.sa_data);
Zhu Yi46441512006-01-24 16:37:59 +08009047 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009048 return 0;
9049}
9050
Jeff Garzikbf794512005-07-31 13:07:26 -04009051static int ipw_wx_set_essid(struct net_device *dev,
9052 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009053 union iwreq_data *wrqu, char *extra)
9054{
9055 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08009056 int length;
John W. Linville9387b7c2008-09-30 20:59:05 -04009057 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06009058
Zhu Yiab644b02006-08-21 11:37:13 +08009059 mutex_lock(&priv->mutex);
9060
9061 if (!wrqu->essid.flags)
9062 {
9063 IPW_DEBUG_WX("Setting ESSID to ANY\n");
9064 ipw_disassociate(priv);
9065 priv->config &= ~CFG_STATIC_ESSID;
9066 ipw_associate(priv);
9067 mutex_unlock(&priv->mutex);
9068 return 0;
9069 }
9070
Zhu Yia9f0d422006-08-21 11:37:26 +08009071 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06009072
9073 priv->config |= CFG_STATIC_ESSID;
9074
Zhu Yia9f0d422006-08-21 11:37:26 +08009075 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
9076 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009077 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009078 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009079 return 0;
9080 }
9081
John W. Linville9387b7c2008-09-30 20:59:05 -04009082 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n",
9083 print_ssid(ssid, extra, length), length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009084
9085 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08009086 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04009087
James Ketrenosc848d0a2005-08-24 21:56:24 -05009088 /* Network configuration changed -- force [re]association */
9089 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
9090 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009091 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009092
Zhu Yi46441512006-01-24 16:37:59 +08009093 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009094 return 0;
9095}
9096
Jeff Garzikbf794512005-07-31 13:07:26 -04009097static int ipw_wx_get_essid(struct net_device *dev,
9098 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009099 union iwreq_data *wrqu, char *extra)
9100{
9101 struct ipw_priv *priv = ieee80211_priv(dev);
John W. Linville9387b7c2008-09-30 20:59:05 -04009102 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06009103
9104 /* If we are associated, trying to associate, or have a statically
9105 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009106 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009107 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04009108 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9109 IPW_DEBUG_WX("Getting essid: '%s'\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04009110 print_ssid(ssid, priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04009111 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06009112 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009113 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009114 } else {
9115 IPW_DEBUG_WX("Getting essid: ANY\n");
9116 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009117 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009118 }
Zhu Yi46441512006-01-24 16:37:59 +08009119 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009120 return 0;
9121}
9122
Jeff Garzikbf794512005-07-31 13:07:26 -04009123static int ipw_wx_set_nick(struct net_device *dev,
9124 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009125 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009126{
James Ketrenos43f66a62005-03-25 12:31:53 -06009127 struct ipw_priv *priv = ieee80211_priv(dev);
9128
9129 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
9130 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
9131 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08009132 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009133 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06009134 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009135 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009136 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08009137 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009138 return 0;
9139
9140}
9141
Jeff Garzikbf794512005-07-31 13:07:26 -04009142static int ipw_wx_get_nick(struct net_device *dev,
9143 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009144 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009145{
James Ketrenos43f66a62005-03-25 12:31:53 -06009146 struct ipw_priv *priv = ieee80211_priv(dev);
9147 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08009148 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009149 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06009150 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009151 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08009152 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009153 return 0;
9154}
9155
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009156static int ipw_wx_set_sens(struct net_device *dev,
9157 struct iw_request_info *info,
9158 union iwreq_data *wrqu, char *extra)
9159{
9160 struct ipw_priv *priv = ieee80211_priv(dev);
9161 int err = 0;
9162
9163 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
9164 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
9165 mutex_lock(&priv->mutex);
9166
9167 if (wrqu->sens.fixed == 0)
9168 {
9169 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
9170 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
9171 goto out;
9172 }
9173 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
9174 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
9175 err = -EINVAL;
9176 goto out;
9177 }
9178
9179 priv->roaming_threshold = wrqu->sens.value;
9180 priv->disassociate_threshold = 3*wrqu->sens.value;
9181 out:
9182 mutex_unlock(&priv->mutex);
9183 return err;
9184}
9185
9186static int ipw_wx_get_sens(struct net_device *dev,
9187 struct iw_request_info *info,
9188 union iwreq_data *wrqu, char *extra)
9189{
9190 struct ipw_priv *priv = ieee80211_priv(dev);
9191 mutex_lock(&priv->mutex);
9192 wrqu->sens.fixed = 1;
9193 wrqu->sens.value = priv->roaming_threshold;
9194 mutex_unlock(&priv->mutex);
9195
9196 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9197 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9198
9199 return 0;
9200}
9201
James Ketrenos43f66a62005-03-25 12:31:53 -06009202static int ipw_wx_set_rate(struct net_device *dev,
9203 struct iw_request_info *info,
9204 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009205{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009206 /* TODO: We should use semaphores or locks for access to priv */
9207 struct ipw_priv *priv = ieee80211_priv(dev);
9208 u32 target_rate = wrqu->bitrate.value;
9209 u32 fixed, mask;
9210
9211 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9212 /* value = X, fixed = 1 means only rate X */
9213 /* value = X, fixed = 0 means all rates lower equal X */
9214
9215 if (target_rate == -1) {
9216 fixed = 0;
9217 mask = IEEE80211_DEFAULT_RATES_MASK;
9218 /* Now we should reassociate */
9219 goto apply;
9220 }
9221
9222 mask = 0;
9223 fixed = wrqu->bitrate.fixed;
9224
9225 if (target_rate == 1000000 || !fixed)
9226 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9227 if (target_rate == 1000000)
9228 goto apply;
9229
9230 if (target_rate == 2000000 || !fixed)
9231 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9232 if (target_rate == 2000000)
9233 goto apply;
9234
9235 if (target_rate == 5500000 || !fixed)
9236 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9237 if (target_rate == 5500000)
9238 goto apply;
9239
9240 if (target_rate == 6000000 || !fixed)
9241 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9242 if (target_rate == 6000000)
9243 goto apply;
9244
9245 if (target_rate == 9000000 || !fixed)
9246 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9247 if (target_rate == 9000000)
9248 goto apply;
9249
9250 if (target_rate == 11000000 || !fixed)
9251 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9252 if (target_rate == 11000000)
9253 goto apply;
9254
9255 if (target_rate == 12000000 || !fixed)
9256 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9257 if (target_rate == 12000000)
9258 goto apply;
9259
9260 if (target_rate == 18000000 || !fixed)
9261 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9262 if (target_rate == 18000000)
9263 goto apply;
9264
9265 if (target_rate == 24000000 || !fixed)
9266 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9267 if (target_rate == 24000000)
9268 goto apply;
9269
9270 if (target_rate == 36000000 || !fixed)
9271 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9272 if (target_rate == 36000000)
9273 goto apply;
9274
9275 if (target_rate == 48000000 || !fixed)
9276 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9277 if (target_rate == 48000000)
9278 goto apply;
9279
9280 if (target_rate == 54000000 || !fixed)
9281 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9282 if (target_rate == 54000000)
9283 goto apply;
9284
9285 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9286 return -EINVAL;
9287
9288 apply:
9289 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9290 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009291 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009292 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009293 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009294 ipw_set_fixed_rate(priv, priv->ieee->mode);
9295 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009296 priv->config |= CFG_FIXED_RATE;
9297
James Ketrenosc848d0a2005-08-24 21:56:24 -05009298 if (priv->rates_mask == mask) {
9299 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009300 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009301 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009302 }
9303
James Ketrenosc848d0a2005-08-24 21:56:24 -05009304 priv->rates_mask = mask;
9305
9306 /* Network configuration changed -- force [re]association */
9307 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9308 if (!ipw_disassociate(priv))
9309 ipw_associate(priv);
9310
Zhu Yi46441512006-01-24 16:37:59 +08009311 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009312 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009313}
9314
Jeff Garzikbf794512005-07-31 13:07:26 -04009315static int ipw_wx_get_rate(struct net_device *dev,
9316 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009317 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009318{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009319 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009320 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009321 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009322 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009323 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009324 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9325 return 0;
9326}
9327
Jeff Garzikbf794512005-07-31 13:07:26 -04009328static int ipw_wx_set_rts(struct net_device *dev,
9329 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009330 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009331{
James Ketrenos43f66a62005-03-25 12:31:53 -06009332 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009333 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009334 if (wrqu->rts.disabled || !wrqu->rts.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009335 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9336 else {
9337 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009338 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009339 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009340 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009341 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009342 priv->rts_threshold = wrqu->rts.value;
9343 }
9344
9345 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009346 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009347 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9348 return 0;
9349}
9350
Jeff Garzikbf794512005-07-31 13:07:26 -04009351static int ipw_wx_get_rts(struct net_device *dev,
9352 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009353 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009354{
James Ketrenos43f66a62005-03-25 12:31:53 -06009355 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009356 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009357 wrqu->rts.value = priv->rts_threshold;
9358 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009359 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009360 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009361 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9362 return 0;
9363}
9364
Jeff Garzikbf794512005-07-31 13:07:26 -04009365static int ipw_wx_set_txpow(struct net_device *dev,
9366 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009367 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009368{
James Ketrenos43f66a62005-03-25 12:31:53 -06009369 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009370 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009371
Zhu Yi46441512006-01-24 16:37:59 +08009372 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009373 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009374 err = -EINPROGRESS;
9375 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009376 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009377
James Ketrenosb095c382005-08-24 22:04:42 -05009378 if (!wrqu->power.fixed)
9379 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009380
James Ketrenosc848d0a2005-08-24 21:56:24 -05009381 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009382 err = -EINVAL;
9383 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009384 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009385
James Ketrenosb095c382005-08-24 22:04:42 -05009386 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009387 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009388 err = -EINVAL;
9389 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009390 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009391
9392 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009393 err = ipw_set_tx_power(priv);
9394 out:
Zhu Yi46441512006-01-24 16:37:59 +08009395 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009396 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009397}
9398
Jeff Garzikbf794512005-07-31 13:07:26 -04009399static int ipw_wx_get_txpow(struct net_device *dev,
9400 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009401 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009402{
James Ketrenos43f66a62005-03-25 12:31:53 -06009403 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009404 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009405 wrqu->power.value = priv->tx_power;
9406 wrqu->power.fixed = 1;
9407 wrqu->power.flags = IW_TXPOW_DBM;
9408 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009409 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009410
Jeff Garzikbf794512005-07-31 13:07:26 -04009411 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009412 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009413
9414 return 0;
9415}
9416
Jeff Garzikbf794512005-07-31 13:07:26 -04009417static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009418 struct iw_request_info *info,
9419 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009420{
9421 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009422 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009423 if (wrqu->frag.disabled || !wrqu->frag.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009424 priv->ieee->fts = DEFAULT_FTS;
9425 else {
9426 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009427 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009428 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009429 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009430 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009431
James Ketrenos43f66a62005-03-25 12:31:53 -06009432 priv->ieee->fts = wrqu->frag.value & ~0x1;
9433 }
9434
9435 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009436 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009437 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9438 return 0;
9439}
9440
Jeff Garzikbf794512005-07-31 13:07:26 -04009441static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009442 struct iw_request_info *info,
9443 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009444{
9445 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009446 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009447 wrqu->frag.value = priv->ieee->fts;
9448 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009449 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009450 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009451 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9452
9453 return 0;
9454}
9455
Jeff Garzikbf794512005-07-31 13:07:26 -04009456static int ipw_wx_set_retry(struct net_device *dev,
9457 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009458 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009459{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009460 struct ipw_priv *priv = ieee80211_priv(dev);
9461
9462 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9463 return -EINVAL;
9464
9465 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9466 return 0;
9467
Zhu Yid5f7ac22006-08-21 11:38:17 +08009468 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009469 return -EINVAL;
9470
Zhu Yi46441512006-01-24 16:37:59 +08009471 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009472 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009473 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009474 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009475 priv->long_retry_limit = (u8) wrqu->retry.value;
9476 else {
9477 priv->short_retry_limit = (u8) wrqu->retry.value;
9478 priv->long_retry_limit = (u8) wrqu->retry.value;
9479 }
9480
9481 ipw_send_retry_limit(priv, priv->short_retry_limit,
9482 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009483 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009484 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9485 priv->short_retry_limit, priv->long_retry_limit);
9486 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009487}
9488
Jeff Garzikbf794512005-07-31 13:07:26 -04009489static int ipw_wx_get_retry(struct net_device *dev,
9490 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009491 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009492{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009493 struct ipw_priv *priv = ieee80211_priv(dev);
9494
Zhu Yi46441512006-01-24 16:37:59 +08009495 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009496 wrqu->retry.disabled = 0;
9497
9498 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009499 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009500 return -EINVAL;
9501 }
9502
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009503 if (wrqu->retry.flags & IW_RETRY_LONG) {
9504 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009505 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009506 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9507 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009508 wrqu->retry.value = priv->short_retry_limit;
9509 } else {
9510 wrqu->retry.flags = IW_RETRY_LIMIT;
9511 wrqu->retry.value = priv->short_retry_limit;
9512 }
Zhu Yi46441512006-01-24 16:37:59 +08009513 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009514
9515 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9516
9517 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009518}
9519
Jeff Garzikbf794512005-07-31 13:07:26 -04009520static int ipw_wx_set_scan(struct net_device *dev,
9521 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009522 union iwreq_data *wrqu, char *extra)
9523{
9524 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009525 struct iw_scan_req *req = (struct iw_scan_req *)extra;
Dan Williamsea177302008-06-02 17:51:23 -04009526 struct delayed_work *work = NULL;
Zhu Yi094c4d22006-08-21 11:39:03 +08009527
Dan Williams0b531672007-10-09 13:55:24 -04009528 mutex_lock(&priv->mutex);
Dan Williamsea177302008-06-02 17:51:23 -04009529
Dan Williams0b531672007-10-09 13:55:24 -04009530 priv->user_requested_scan = 1;
Dan Williams0b531672007-10-09 13:55:24 -04009531
Zhu Yi094c4d22006-08-21 11:39:03 +08009532 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009533 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
Dan Williamsea177302008-06-02 17:51:23 -04009534 int len = min((int)req->essid_len,
9535 (int)sizeof(priv->direct_scan_ssid));
9536 memcpy(priv->direct_scan_ssid, req->essid, len);
9537 priv->direct_scan_ssid_len = len;
9538 work = &priv->request_direct_scan;
9539 } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9540 work = &priv->request_passive_scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009541 }
Dan Williamsea177302008-06-02 17:51:23 -04009542 } else {
9543 /* Normal active broadcast scan */
9544 work = &priv->request_scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009545 }
James Ketrenos8935f392005-10-05 15:59:08 -05009546
Dan Williamsea177302008-06-02 17:51:23 -04009547 mutex_unlock(&priv->mutex);
9548
James Ketrenos43f66a62005-03-25 12:31:53 -06009549 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009550
Dan Williamsea177302008-06-02 17:51:23 -04009551 queue_delayed_work(priv->workqueue, work, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05009552
James Ketrenos43f66a62005-03-25 12:31:53 -06009553 return 0;
9554}
9555
Jeff Garzikbf794512005-07-31 13:07:26 -04009556static int ipw_wx_get_scan(struct net_device *dev,
9557 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009558 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009559{
James Ketrenos43f66a62005-03-25 12:31:53 -06009560 struct ipw_priv *priv = ieee80211_priv(dev);
9561 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9562}
9563
Jeff Garzikbf794512005-07-31 13:07:26 -04009564static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009565 struct iw_request_info *info,
9566 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009567{
9568 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009569 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009570 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009571
Zhu Yi46441512006-01-24 16:37:59 +08009572 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009573 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009574
Hong Liucaeff812005-08-05 17:25:50 +08009575 /* In IBSS mode, we need to notify the firmware to update
9576 * the beacon info after we changed the capability. */
9577 if (cap != priv->capability &&
9578 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9579 priv->status & STATUS_ASSOCIATED)
9580 ipw_disassociate(priv);
9581
Zhu Yi46441512006-01-24 16:37:59 +08009582 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009583 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009584}
9585
Jeff Garzikbf794512005-07-31 13:07:26 -04009586static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009587 struct iw_request_info *info,
9588 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009589{
9590 struct ipw_priv *priv = ieee80211_priv(dev);
9591 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9592}
9593
Jeff Garzikbf794512005-07-31 13:07:26 -04009594static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009595 struct iw_request_info *info,
9596 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009597{
9598 struct ipw_priv *priv = ieee80211_priv(dev);
9599 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009600 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009601 if (wrqu->power.disabled) {
9602 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9603 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9604 if (err) {
9605 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009606 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009607 return err;
9608 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009609 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009610 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009611 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009612 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009613
9614 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009615 case IW_POWER_ON: /* If not specified */
9616 case IW_POWER_MODE: /* If set all mask */
Jean Delvarec03983a2007-10-19 23:22:55 +02009617 case IW_POWER_ALL_R: /* If explicitly state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009618 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009619 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009620 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9621 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009622 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009623 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009624 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009625
James Ketrenos43f66a62005-03-25 12:31:53 -06009626 /* If the user hasn't specified a power management mode yet, default
9627 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009628 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009629 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009630 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009631 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
Zhu Yi4e157f02007-07-12 16:09:32 +08009632
James Ketrenos43f66a62005-03-25 12:31:53 -06009633 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9634 if (err) {
9635 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009636 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009637 return err;
9638 }
9639
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009640 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009641 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009642 return 0;
9643}
9644
Jeff Garzikbf794512005-07-31 13:07:26 -04009645static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009646 struct iw_request_info *info,
9647 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009648{
9649 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009650 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009651 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009652 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009653 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009654 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009655
Zhu Yi46441512006-01-24 16:37:59 +08009656 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009657 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009658
James Ketrenos43f66a62005-03-25 12:31:53 -06009659 return 0;
9660}
9661
Jeff Garzikbf794512005-07-31 13:07:26 -04009662static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009663 struct iw_request_info *info,
9664 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009665{
9666 struct ipw_priv *priv = ieee80211_priv(dev);
9667 int mode = *(int *)extra;
9668 int err;
Zhu Yi4e157f02007-07-12 16:09:32 +08009669
Zhu Yi46441512006-01-24 16:37:59 +08009670 mutex_lock(&priv->mutex);
Zhu Yi4e157f02007-07-12 16:09:32 +08009671 if ((mode < 1) || (mode > IPW_POWER_LIMIT))
James Ketrenos43f66a62005-03-25 12:31:53 -06009672 mode = IPW_POWER_AC;
Jeff Garzikbf794512005-07-31 13:07:26 -04009673
Zhu Yi4e157f02007-07-12 16:09:32 +08009674 if (IPW_POWER_LEVEL(priv->power_mode) != mode) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009675 err = ipw_send_power_mode(priv, mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009676 if (err) {
9677 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009678 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009679 return err;
9680 }
Zhu Yi4e157f02007-07-12 16:09:32 +08009681 priv->power_mode = IPW_POWER_ENABLED | mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06009682 }
Zhu Yi46441512006-01-24 16:37:59 +08009683 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009684 return 0;
9685}
9686
9687#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009688static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009689 struct iw_request_info *info,
9690 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009691{
9692 struct ipw_priv *priv = ieee80211_priv(dev);
9693 int level = IPW_POWER_LEVEL(priv->power_mode);
9694 char *p = extra;
9695
9696 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9697
9698 switch (level) {
9699 case IPW_POWER_AC:
9700 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9701 break;
9702 case IPW_POWER_BATTERY:
9703 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9704 break;
9705 default:
9706 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009707 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009708 timeout_duration[level - 1] / 1000,
9709 period_duration[level - 1] / 1000);
9710 }
9711
9712 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009713 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009714
9715 wrqu->data.length = p - extra + 1;
9716
9717 return 0;
9718}
9719
9720static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009721 struct iw_request_info *info,
9722 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009723{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009724 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009725 int mode = *(int *)extra;
9726 u8 band = 0, modulation = 0;
9727
9728 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009729 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009730 return -EINVAL;
9731 }
Zhu Yi46441512006-01-24 16:37:59 +08009732 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009733 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009734 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009735 if (mode & IEEE_A) {
9736 band |= IEEE80211_52GHZ_BAND;
9737 modulation |= IEEE80211_OFDM_MODULATION;
9738 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009739 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009740 } else {
9741 if (mode & IEEE_A) {
9742 IPW_WARNING("Attempt to set 2200BG into "
9743 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009744 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009745 return -EINVAL;
9746 }
9747
James Ketrenosa33a1982005-09-14 14:28:59 -05009748 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009749 }
9750
9751 if (mode & IEEE_B) {
9752 band |= IEEE80211_24GHZ_BAND;
9753 modulation |= IEEE80211_CCK_MODULATION;
9754 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009755 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009756
James Ketrenos43f66a62005-03-25 12:31:53 -06009757 if (mode & IEEE_G) {
9758 band |= IEEE80211_24GHZ_BAND;
9759 modulation |= IEEE80211_OFDM_MODULATION;
9760 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009761 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009762
9763 priv->ieee->mode = mode;
9764 priv->ieee->freq_band = band;
9765 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009766 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009767
James Ketrenosc848d0a2005-08-24 21:56:24 -05009768 /* Network configuration changed -- force [re]association */
9769 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9770 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009771 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009772 ipw_associate(priv);
9773 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009774
James Ketrenosa613bff2005-08-24 21:43:11 -05009775 /* Update the band LEDs */
9776 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009777
Jeff Garzikbf794512005-07-31 13:07:26 -04009778 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009779 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009780 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009781 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009782 return 0;
9783}
9784
9785static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009786 struct iw_request_info *info,
9787 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009788{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009789 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009790 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009791 switch (priv->ieee->mode) {
9792 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009793 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9794 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009795 case IEEE_B:
9796 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9797 break;
9798 case IEEE_A | IEEE_B:
9799 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9800 break;
9801 case IEEE_G:
9802 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9803 break;
9804 case IEEE_A | IEEE_G:
9805 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9806 break;
9807 case IEEE_B | IEEE_G:
9808 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9809 break;
9810 case IEEE_A | IEEE_B | IEEE_G:
9811 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9812 break;
9813 default:
9814 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009815 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009816 }
9817
James Ketrenos43f66a62005-03-25 12:31:53 -06009818 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9819
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009820 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009821 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009822
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009823 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009824}
9825
James Ketrenosea2b26e2005-08-24 21:25:16 -05009826static int ipw_wx_set_preamble(struct net_device *dev,
9827 struct iw_request_info *info,
9828 union iwreq_data *wrqu, char *extra)
9829{
9830 struct ipw_priv *priv = ieee80211_priv(dev);
9831 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009832 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009833 /* Switching from SHORT -> LONG requires a disassociation */
9834 if (mode == 1) {
9835 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9836 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009837
9838 /* Network configuration changed -- force [re]association */
9839 IPW_DEBUG_ASSOC
9840 ("[re]association triggered due to preamble change.\n");
9841 if (!ipw_disassociate(priv))
9842 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009843 }
9844 goto done;
9845 }
9846
9847 if (mode == 0) {
9848 priv->config &= ~CFG_PREAMBLE_LONG;
9849 goto done;
9850 }
Zhu Yi46441512006-01-24 16:37:59 +08009851 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009852 return -EINVAL;
9853
9854 done:
Zhu Yi46441512006-01-24 16:37:59 +08009855 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009856 return 0;
9857}
9858
9859static int ipw_wx_get_preamble(struct net_device *dev,
9860 struct iw_request_info *info,
9861 union iwreq_data *wrqu, char *extra)
9862{
9863 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009864 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009865 if (priv->config & CFG_PREAMBLE_LONG)
9866 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9867 else
9868 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009869 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009870 return 0;
9871}
9872
James Ketrenosb095c382005-08-24 22:04:42 -05009873#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009874static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009875 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009876 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009877{
James Ketrenos43f66a62005-03-25 12:31:53 -06009878 struct ipw_priv *priv = ieee80211_priv(dev);
9879 int *parms = (int *)extra;
9880 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009881 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009882 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009883 if (enable) {
9884 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009885#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009886 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9887#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009888 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009889#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009890 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009891 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009892
James Ketrenos43f66a62005-03-25 12:31:53 -06009893 ipw_set_channel(priv, parms[1]);
9894 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009895 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009896 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009897 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009898 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009899 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009900 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009901 }
Zhu Yi46441512006-01-24 16:37:59 +08009902 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009903 return 0;
9904}
9905
Pavel Machek67fd6b42006-07-11 15:34:05 +02009906#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009907
Jeff Garzikbf794512005-07-31 13:07:26 -04009908static int ipw_wx_reset(struct net_device *dev,
9909 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009910 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009911{
James Ketrenos43f66a62005-03-25 12:31:53 -06009912 struct ipw_priv *priv = ieee80211_priv(dev);
9913 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009914 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009915 return 0;
9916}
James Ketrenosb095c382005-08-24 22:04:42 -05009917
James Ketrenosb095c382005-08-24 22:04:42 -05009918static int ipw_wx_sw_reset(struct net_device *dev,
9919 struct iw_request_info *info,
9920 union iwreq_data *wrqu, char *extra)
9921{
9922 struct ipw_priv *priv = ieee80211_priv(dev);
9923 union iwreq_data wrqu_sec = {
9924 .encoding = {
9925 .flags = IW_ENCODE_DISABLED,
9926 },
9927 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009928 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009929
9930 IPW_DEBUG_WX("SW_RESET\n");
9931
Zhu Yi46441512006-01-24 16:37:59 +08009932 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009933
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009934 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009935 if (!ret) {
9936 free_firmware();
9937 ipw_adapter_restart(priv);
9938 }
James Ketrenosb095c382005-08-24 22:04:42 -05009939
9940 /* The SW reset bit might have been toggled on by the 'disable'
9941 * module parameter, so take appropriate action */
9942 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9943
Zhu Yi46441512006-01-24 16:37:59 +08009944 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009945 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009946 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009947
9948 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9949 /* Configuration likely changed -- force [re]association */
9950 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9951 "reset.\n");
9952 if (!ipw_disassociate(priv))
9953 ipw_associate(priv);
9954 }
9955
Zhu Yi46441512006-01-24 16:37:59 +08009956 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009957
9958 return 0;
9959}
James Ketrenos43f66a62005-03-25 12:31:53 -06009960
9961/* Rebase the WE IOCTLs to zero for the handler array */
9962#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009963static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009964 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9965 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9966 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9967 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9968 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009969 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9970 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009971 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9972 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9973 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9974 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9975 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9976 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9977 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9978 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9979 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9980 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9981 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9982 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9983 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9984 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9985 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9986 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9987 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9988 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9989 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9990 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9991 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9992 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9993 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009994 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9995 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9996 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9997 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009998 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9999 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
10000 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
10001 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
10002 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
10003 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
10004 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -060010005};
10006
James Ketrenosb095c382005-08-24 22:04:42 -050010007enum {
10008 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
10009 IPW_PRIV_GET_POWER,
10010 IPW_PRIV_SET_MODE,
10011 IPW_PRIV_GET_MODE,
10012 IPW_PRIV_SET_PREAMBLE,
10013 IPW_PRIV_GET_PREAMBLE,
10014 IPW_PRIV_RESET,
10015 IPW_PRIV_SW_RESET,
10016#ifdef CONFIG_IPW2200_MONITOR
10017 IPW_PRIV_SET_MONITOR,
10018#endif
10019};
James Ketrenos43f66a62005-03-25 12:31:53 -060010020
Jeff Garzikbf794512005-07-31 13:07:26 -040010021static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -060010022 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010023 .cmd = IPW_PRIV_SET_POWER,
10024 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10025 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010026 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010027 .cmd = IPW_PRIV_GET_POWER,
10028 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10029 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010030 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010031 .cmd = IPW_PRIV_SET_MODE,
10032 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10033 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010034 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010035 .cmd = IPW_PRIV_GET_MODE,
10036 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10037 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010038 {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010039 .cmd = IPW_PRIV_SET_PREAMBLE,
10040 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10041 .name = "set_preamble"},
10042 {
10043 .cmd = IPW_PRIV_GET_PREAMBLE,
10044 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
10045 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010046 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010047 IPW_PRIV_RESET,
10048 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -050010049 {
10050 IPW_PRIV_SW_RESET,
10051 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
10052#ifdef CONFIG_IPW2200_MONITOR
10053 {
10054 IPW_PRIV_SET_MONITOR,
10055 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
10056#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -060010057};
10058
10059static iw_handler ipw_priv_handler[] = {
10060 ipw_wx_set_powermode,
10061 ipw_wx_get_powermode,
10062 ipw_wx_set_wireless_mode,
10063 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -050010064 ipw_wx_set_preamble,
10065 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -040010066 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -050010067 ipw_wx_sw_reset,
10068#ifdef CONFIG_IPW2200_MONITOR
10069 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -060010070#endif
10071};
10072
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010073static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010074 .standard = ipw_wx_handlers,
10075 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
10076 .num_private = ARRAY_SIZE(ipw_priv_handler),
10077 .num_private_args = ARRAY_SIZE(ipw_priv_args),
10078 .private = ipw_priv_handler,
10079 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000010080 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -060010081};
10082
James Ketrenos43f66a62005-03-25 12:31:53 -060010083/*
10084 * Get wireless statistics.
10085 * Called by /proc/net/wireless
10086 * Also called by SIOCGIWSTATS
10087 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010088static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -060010089{
10090 struct ipw_priv *priv = ieee80211_priv(dev);
10091 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010092
James Ketrenos43f66a62005-03-25 12:31:53 -060010093 wstats = &priv->wstats;
10094
James Ketrenosea2b26e2005-08-24 21:25:16 -050010095 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -050010096 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -060010097 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
10098 * and associated; if not associcated, the values are all meaningless
10099 * anyway, so set them all to NULL and INVALID */
10100 if (!(priv->status & STATUS_ASSOCIATED)) {
10101 wstats->miss.beacon = 0;
10102 wstats->discard.retries = 0;
10103 wstats->qual.qual = 0;
10104 wstats->qual.level = 0;
10105 wstats->qual.noise = 0;
10106 wstats->qual.updated = 7;
10107 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010108 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -060010109 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010110 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010111
10112 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +080010113 wstats->qual.level = priv->exp_avg_rssi;
10114 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -060010115 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +080010116 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010117
10118 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
10119 wstats->discard.retries = priv->last_tx_failures;
10120 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -040010121
James Ketrenos43f66a62005-03-25 12:31:53 -060010122/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
10123 goto fail_get_ordinal;
10124 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -040010125
James Ketrenos43f66a62005-03-25 12:31:53 -060010126 return wstats;
10127}
10128
James Ketrenos43f66a62005-03-25 12:31:53 -060010129/* net device stuff */
10130
Arjan van de Ven858119e2006-01-14 13:20:43 -080010131static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -060010132{
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010133 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +080010134 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010135 sys_config->answer_broadcast_ssid_probe = 0;
10136 sys_config->accept_all_data_frames = 0;
10137 sys_config->accept_non_directed_frames = 1;
10138 sys_config->exclude_unicast_unencrypted = 0;
10139 sys_config->disable_unicast_decryption = 1;
10140 sys_config->exclude_multicast_unencrypted = 0;
10141 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010142 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10143 antenna = CFG_SYS_ANTENNA_BOTH;
10144 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010145 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010146 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010147 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010148 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010149 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010150 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010151}
10152
10153static int ipw_net_open(struct net_device *dev)
10154{
James Ketrenos43f66a62005-03-25 12:31:53 -060010155 IPW_DEBUG_INFO("dev->open\n");
David S. Miller521c4d92008-07-22 18:32:47 -070010156 netif_start_queue(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -060010157 return 0;
10158}
10159
10160static int ipw_net_stop(struct net_device *dev)
10161{
10162 IPW_DEBUG_INFO("dev->close\n");
10163 netif_stop_queue(dev);
10164 return 0;
10165}
10166
10167/*
10168todo:
10169
10170modify to send one tfd per fragment instead of using chunking. otherwise
10171we need to heavily modify the ieee80211_skb_to_txb.
10172*/
10173
Arjan van de Ven858119e2006-01-14 13:20:43 -080010174static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010175 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010176{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010177 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010178 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010179 int i = 0;
10180 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010181#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010182 int tx_id = ipw_get_tx_queue_number(priv, pri);
10183 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10184#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010185 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010186#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010187 struct clx2_queue *q = &txq->q;
10188 u8 id, hdr_len, unicast;
10189 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010190 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010191
Zhu Yib8ddafd2008-11-27 13:42:20 +080010192 if (!(priv->status & STATUS_ASSOCIATED))
10193 goto drop;
10194
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010195 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010196 switch (priv->ieee->iw_mode) {
10197 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010198 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010199 id = ipw_find_station(priv, hdr->addr1);
10200 if (id == IPW_INVALID_STATION) {
10201 id = ipw_add_station(priv, hdr->addr1);
10202 if (id == IPW_INVALID_STATION) {
10203 IPW_WARNING("Attempt to send data to "
Johannes Berge1749612008-10-27 15:59:26 -070010204 "invalid cell: %pM\n",
10205 hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010206 goto drop;
10207 }
10208 }
10209 break;
10210
10211 case IW_MODE_INFRA:
10212 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010213 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010214 id = 0;
10215 break;
10216 }
10217
10218 tfd = &txq->bd[q->first_empty];
10219 txq->txb[q->first_empty] = txb;
10220 memset(tfd, 0, sizeof(*tfd));
10221 tfd->u.data.station_number = id;
10222
10223 tfd->control_flags.message_type = TX_FRAME_TYPE;
10224 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10225
10226 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010227 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010228 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010229
James Ketrenos43f66a62005-03-25 12:31:53 -060010230 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010231 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010232 else
James Ketrenosb095c382005-08-24 22:04:42 -050010233 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010234
James Ketrenosea2b26e2005-08-24 21:25:16 -050010235 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10236 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010237
James Ketrenosc848d0a2005-08-24 21:56:24 -050010238 fc = le16_to_cpu(hdr->frame_ctl);
10239 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010240
10241 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10242
James Ketrenosb095c382005-08-24 22:04:42 -050010243 if (likely(unicast))
10244 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10245
10246 if (txb->encrypted && !priv->ieee->host_encrypt) {
10247 switch (priv->ieee->sec.level) {
10248 case SEC_LEVEL_3:
10249 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010250 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010251 /* XXX: ACK flag must be set for CCMP even if it
10252 * is a multicast/broadcast packet, because CCMP
10253 * group communication encrypted by GTK is
10254 * actually done by the AP. */
10255 if (!unicast)
10256 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10257
10258 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10259 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10260 tfd->u.data.key_index = 0;
10261 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10262 break;
10263 case SEC_LEVEL_2:
10264 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010265 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010266 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10267 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10268 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10269 break;
10270 case SEC_LEVEL_1:
10271 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010272 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
John W. Linville274bfb82008-10-29 11:35:05 -040010273 tfd->u.data.key_index = priv->ieee->crypt_info.tx_keyidx;
10274 if (priv->ieee->sec.key_sizes[priv->ieee->crypt_info.tx_keyidx] <=
James Ketrenosb095c382005-08-24 22:04:42 -050010275 40)
10276 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10277 else
10278 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10279 break;
10280 case SEC_LEVEL_0:
10281 break;
10282 default:
10283 printk(KERN_ERR "Unknow security level %d\n",
10284 priv->ieee->sec.level);
10285 break;
10286 }
10287 } else
10288 /* No hardware encryption */
10289 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10290
Zhu Yie43e3c12006-04-13 17:20:45 +080010291#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010292 if (fc & IEEE80211_STYPE_QOS_DATA)
10293 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010294#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010295
James Ketrenos43f66a62005-03-25 12:31:53 -060010296 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010297 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10298 txb->nr_frags));
10299 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10300 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10301 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10302 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10303 i, le32_to_cpu(tfd->u.data.num_chunks),
10304 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010305 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010306 i, tfd->u.data.num_chunks,
10307 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010308 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010309 txb->fragments[i]->len - hdr_len);
10310
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010311 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010312 cpu_to_le32(pci_map_single
10313 (priv->pci_dev,
10314 txb->fragments[i]->data + hdr_len,
10315 txb->fragments[i]->len - hdr_len,
10316 PCI_DMA_TODEVICE));
10317 tfd->u.data.chunk_len[i] =
10318 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010319 }
10320
10321 if (i != txb->nr_frags) {
10322 struct sk_buff *skb;
10323 u16 remaining_bytes = 0;
10324 int j;
10325
10326 for (j = i; j < txb->nr_frags; j++)
10327 remaining_bytes += txb->fragments[j]->len - hdr_len;
10328
10329 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10330 remaining_bytes);
10331 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10332 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010333 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010334 for (j = i; j < txb->nr_frags; j++) {
10335 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010336
James Ketrenos43f66a62005-03-25 12:31:53 -060010337 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010338 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010339 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010340 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010341 }
10342 dev_kfree_skb_any(txb->fragments[i]);
10343 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010344 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010345 cpu_to_le32(pci_map_single
10346 (priv->pci_dev, skb->data,
Al Viro49587302007-12-27 01:57:47 -050010347 remaining_bytes,
James Ketrenosa613bff2005-08-24 21:43:11 -050010348 PCI_DMA_TODEVICE));
10349
Marcin Slusarz5c058632008-02-13 00:06:12 +010010350 le32_add_cpu(&tfd->u.data.num_chunks, 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010351 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010352 }
10353
10354 /* kick DMA */
10355 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10356 ipw_write32(priv, q->reg_w, q->first_empty);
10357
Dan Williams943dbef2008-02-14 17:49:41 -050010358 if (ipw_tx_queue_space(q) < q->high_mark)
James Ketrenosf6970142006-02-14 09:10:51 +080010359 netif_stop_queue(priv->net_dev);
10360
James Ketrenos227d2dc2005-07-28 16:25:55 -050010361 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010362
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010363 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010364 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10365 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010366 return NETDEV_TX_OK;
10367}
10368
10369static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10370{
10371 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010372#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010373 int tx_id = ipw_get_tx_queue_number(priv, pri);
10374 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10375#else
10376 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010377#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010378
Dan Williams943dbef2008-02-14 17:49:41 -050010379 if (ipw_tx_queue_space(&txq->q) < txq->q.high_mark)
James Ketrenos227d2dc2005-07-28 16:25:55 -050010380 return 1;
10381
10382 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010383}
10384
Zhu Yid685b8c2006-04-13 17:20:27 +080010385#ifdef CONFIG_IPW2200_PROMISCUOUS
10386static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10387 struct ieee80211_txb *txb)
10388{
10389 struct ieee80211_rx_stats dummystats;
10390 struct ieee80211_hdr *hdr;
10391 u8 n;
10392 u16 filter = priv->prom_priv->filter;
10393 int hdr_only = 0;
10394
10395 if (filter & IPW_PROM_NO_TX)
10396 return;
10397
10398 memset(&dummystats, 0, sizeof(dummystats));
10399
10400 /* Filtering of fragment chains is done agains the first fragment */
10401 hdr = (void *)txb->fragments[0]->data;
John W. Linville72118012008-09-30 21:43:03 -040010402 if (ieee80211_is_management(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010403 if (filter & IPW_PROM_NO_MGMT)
10404 return;
10405 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10406 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -040010407 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010408 if (filter & IPW_PROM_NO_CTL)
10409 return;
10410 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10411 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -040010412 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010413 if (filter & IPW_PROM_NO_DATA)
10414 return;
10415 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10416 hdr_only = 1;
10417 }
10418
10419 for(n=0; n<txb->nr_frags; ++n) {
10420 struct sk_buff *src = txb->fragments[n];
10421 struct sk_buff *dst;
10422 struct ieee80211_radiotap_header *rt_hdr;
10423 int len;
10424
10425 if (hdr_only) {
10426 hdr = (void *)src->data;
John W. Linville72118012008-09-30 21:43:03 -040010427 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_control));
Zhu Yid685b8c2006-04-13 17:20:27 +080010428 } else
10429 len = src->len;
10430
Johannes Berg007e5dd2008-11-27 23:13:38 +010010431 dst = alloc_skb(len + sizeof(*rt_hdr), GFP_ATOMIC);
10432 if (!dst)
10433 continue;
Zhu Yid685b8c2006-04-13 17:20:27 +080010434
10435 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10436
10437 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10438 rt_hdr->it_pad = 0;
10439 rt_hdr->it_present = 0; /* after all, it's just an idea */
Al Viro743b84d2007-12-27 01:43:16 -050010440 rt_hdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_CHANNEL);
Zhu Yid685b8c2006-04-13 17:20:27 +080010441
Al Viroe62e1ee2007-12-27 01:36:46 -050010442 *(__le16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
Zhu Yid685b8c2006-04-13 17:20:27 +080010443 ieee80211chan2mhz(priv->channel));
10444 if (priv->channel > 14) /* 802.11a */
Al Viroe62e1ee2007-12-27 01:36:46 -050010445 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010446 cpu_to_le16(IEEE80211_CHAN_OFDM |
10447 IEEE80211_CHAN_5GHZ);
10448 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
Al Viroe62e1ee2007-12-27 01:36:46 -050010449 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010450 cpu_to_le16(IEEE80211_CHAN_CCK |
10451 IEEE80211_CHAN_2GHZ);
10452 else /* 802.11g */
Al Viroe62e1ee2007-12-27 01:36:46 -050010453 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010454 cpu_to_le16(IEEE80211_CHAN_OFDM |
10455 IEEE80211_CHAN_2GHZ);
10456
Al Viro743b84d2007-12-27 01:43:16 -050010457 rt_hdr->it_len = cpu_to_le16(dst->len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010458
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -030010459 skb_copy_from_linear_data(src, skb_put(dst, len), len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010460
10461 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10462 dev_kfree_skb_any(dst);
10463 }
10464}
10465#endif
10466
James Ketrenos43f66a62005-03-25 12:31:53 -060010467static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010468 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010469{
10470 struct ipw_priv *priv = ieee80211_priv(dev);
10471 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010472 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010473
10474 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010475 spin_lock_irqsave(&priv->lock, flags);
10476
Zhu Yid685b8c2006-04-13 17:20:27 +080010477#ifdef CONFIG_IPW2200_PROMISCUOUS
10478 if (rtap_iface && netif_running(priv->prom_net_dev))
10479 ipw_handle_promiscuous_tx(priv, txb);
10480#endif
10481
James Ketrenos227d2dc2005-07-28 16:25:55 -050010482 ret = ipw_tx_skb(priv, txb, pri);
10483 if (ret == NETDEV_TX_OK)
10484 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010485 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010486
James Ketrenos227d2dc2005-07-28 16:25:55 -050010487 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010488}
10489
James Ketrenos43f66a62005-03-25 12:31:53 -060010490static void ipw_net_set_multicast_list(struct net_device *dev)
10491{
10492
10493}
10494
10495static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10496{
10497 struct ipw_priv *priv = ieee80211_priv(dev);
10498 struct sockaddr *addr = p;
Joe Perches0795af52007-10-03 17:59:30 -070010499
James Ketrenos43f66a62005-03-25 12:31:53 -060010500 if (!is_valid_ether_addr(addr->sa_data))
10501 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010502 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010503 priv->config |= CFG_CUSTOM_MAC;
10504 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
Johannes Berge1749612008-10-27 15:59:26 -070010505 printk(KERN_INFO "%s: Setting MAC to %pM\n",
10506 priv->net_dev->name, priv->mac_addr);
James Ketrenosa613bff2005-08-24 21:43:11 -050010507 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010508 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010509 return 0;
10510}
10511
Jeff Garzikbf794512005-07-31 13:07:26 -040010512static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010513 struct ethtool_drvinfo *info)
10514{
10515 struct ipw_priv *p = ieee80211_priv(dev);
10516 char vers[64];
10517 char date[32];
10518 u32 len;
10519
10520 strcpy(info->driver, DRV_NAME);
10521 strcpy(info->version, DRV_VERSION);
10522
10523 len = sizeof(vers);
10524 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10525 len = sizeof(date);
10526 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10527
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010528 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010529 vers, date);
10530 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010531 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010532}
10533
10534static u32 ipw_ethtool_get_link(struct net_device *dev)
10535{
10536 struct ipw_priv *priv = ieee80211_priv(dev);
10537 return (priv->status & STATUS_ASSOCIATED) != 0;
10538}
10539
10540static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10541{
James Ketrenosb095c382005-08-24 22:04:42 -050010542 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010543}
10544
10545static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010546 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010547{
10548 struct ipw_priv *p = ieee80211_priv(dev);
10549
James Ketrenosb095c382005-08-24 22:04:42 -050010550 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010551 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010552 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010553 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010554 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010555 return 0;
10556}
10557
10558static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010559 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010560{
10561 struct ipw_priv *p = ieee80211_priv(dev);
10562 int i;
10563
James Ketrenosb095c382005-08-24 22:04:42 -050010564 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010565 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010566 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010567 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010568 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10569 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010570 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010571 return 0;
10572}
10573
Jeff Garzik7282d492006-09-13 14:30:00 -040010574static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010575 .get_link = ipw_ethtool_get_link,
10576 .get_drvinfo = ipw_ethtool_get_drvinfo,
10577 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10578 .get_eeprom = ipw_ethtool_get_eeprom,
10579 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010580};
10581
David Howells7d12e782006-10-05 14:55:46 +010010582static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010583{
10584 struct ipw_priv *priv = data;
10585 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010586
James Ketrenos43f66a62005-03-25 12:31:53 -060010587 if (!priv)
10588 return IRQ_NONE;
10589
Zhu Yi89c318e2006-06-08 22:19:49 -070010590 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010591
10592 if (!(priv->status & STATUS_INT_ENABLED)) {
Zhu Yid00d0122007-07-12 16:09:40 +080010593 /* IRQ is disabled */
James Ketrenos43f66a62005-03-25 12:31:53 -060010594 goto none;
10595 }
10596
James Ketrenosb095c382005-08-24 22:04:42 -050010597 inta = ipw_read32(priv, IPW_INTA_RW);
10598 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010599
James Ketrenos43f66a62005-03-25 12:31:53 -060010600 if (inta == 0xFFFFFFFF) {
10601 /* Hardware disappeared */
10602 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10603 goto none;
10604 }
10605
James Ketrenosb095c382005-08-24 22:04:42 -050010606 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010607 /* Shared interrupt */
10608 goto none;
10609 }
10610
10611 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010612 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010613
James Ketrenos43f66a62005-03-25 12:31:53 -060010614 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010615 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10616 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010617
James Ketrenos43f66a62005-03-25 12:31:53 -060010618 /* Cache INTA value for our tasklet */
10619 priv->isr_inta = inta;
10620
10621 tasklet_schedule(&priv->irq_tasklet);
10622
Zhu Yi89c318e2006-06-08 22:19:49 -070010623 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010624
10625 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010626 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010627 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010628 return IRQ_NONE;
10629}
10630
10631static void ipw_rf_kill(void *adapter)
10632{
10633 struct ipw_priv *priv = adapter;
10634 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010635
James Ketrenos43f66a62005-03-25 12:31:53 -060010636 spin_lock_irqsave(&priv->lock, flags);
10637
10638 if (rf_kill_active(priv)) {
10639 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10640 if (priv->workqueue)
10641 queue_delayed_work(priv->workqueue,
10642 &priv->rf_kill, 2 * HZ);
10643 goto exit_unlock;
10644 }
10645
10646 /* RF Kill is now disabled, so bring the device back up */
10647
10648 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10649 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10650 "device\n");
10651
10652 /* we can not do an adapter restart while inside an irq lock */
10653 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010654 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010655 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10656 "enabled\n");
10657
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010658 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010659 spin_unlock_irqrestore(&priv->lock, flags);
10660}
10661
David Howellsc4028952006-11-22 14:57:56 +000010662static void ipw_bg_rf_kill(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010663{
David Howellsc4028952006-11-22 14:57:56 +000010664 struct ipw_priv *priv =
10665 container_of(work, struct ipw_priv, rf_kill.work);
Zhu Yi46441512006-01-24 16:37:59 +080010666 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010667 ipw_rf_kill(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010668 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010669}
10670
Adrian Bunka73e22b2006-01-21 01:39:42 +010010671static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010672{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010673 priv->last_seq_num = -1;
10674 priv->last_frag_num = -1;
10675 priv->last_packet_time = 0;
10676
James Ketrenosa613bff2005-08-24 21:43:11 -050010677 netif_carrier_on(priv->net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050010678
James Ketrenosc848d0a2005-08-24 21:56:24 -050010679 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010680 cancel_delayed_work(&priv->request_direct_scan);
10681 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010682 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010683 ipw_reset_stats(priv);
10684 /* Ensure the rate is updated immediately */
10685 priv->last_rate = ipw_get_current_rate(priv);
10686 ipw_gather_stats(priv);
10687 ipw_led_link_up(priv);
10688 notify_wx_assoc_event(priv);
10689
10690 if (priv->config & CFG_BACKGROUND_SCAN)
10691 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10692}
10693
David Howellsc4028952006-11-22 14:57:56 +000010694static void ipw_bg_link_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010695{
David Howellsc4028952006-11-22 14:57:56 +000010696 struct ipw_priv *priv =
10697 container_of(work, struct ipw_priv, link_up);
Zhu Yi46441512006-01-24 16:37:59 +080010698 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010699 ipw_link_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010700 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010701}
10702
Adrian Bunka73e22b2006-01-21 01:39:42 +010010703static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010704{
10705 ipw_led_link_down(priv);
10706 netif_carrier_off(priv->net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050010707 notify_wx_assoc_event(priv);
10708
10709 /* Cancel any queued work ... */
10710 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010711 cancel_delayed_work(&priv->request_direct_scan);
10712 cancel_delayed_work(&priv->request_passive_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -050010713 cancel_delayed_work(&priv->adhoc_check);
10714 cancel_delayed_work(&priv->gather_stats);
10715
10716 ipw_reset_stats(priv);
10717
James Ketrenosafbf30a2005-08-25 00:05:33 -050010718 if (!(priv->status & STATUS_EXIT_PENDING)) {
10719 /* Queue up another scan... */
David Howellsc4028952006-11-22 14:57:56 +000010720 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
Dan Williams0b531672007-10-09 13:55:24 -040010721 } else
10722 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010723}
10724
David Howellsc4028952006-11-22 14:57:56 +000010725static void ipw_bg_link_down(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_down);
Zhu Yi46441512006-01-24 16:37:59 +080010729 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010730 ipw_link_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010731 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010732}
10733
Adrian Bunk2ef19e62007-12-11 23:20:22 +010010734static int __devinit ipw_setup_deferred_work(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010735{
10736 int ret = 0;
10737
James Ketrenos43f66a62005-03-25 12:31:53 -060010738 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010739 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010740 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010741
David Howellsc4028952006-11-22 14:57:56 +000010742 INIT_DELAYED_WORK(&priv->adhoc_check, ipw_bg_adhoc_check);
10743 INIT_WORK(&priv->associate, ipw_bg_associate);
10744 INIT_WORK(&priv->disassociate, ipw_bg_disassociate);
10745 INIT_WORK(&priv->system_config, ipw_system_config);
10746 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish);
10747 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart);
10748 INIT_DELAYED_WORK(&priv->rf_kill, ipw_bg_rf_kill);
10749 INIT_WORK(&priv->up, ipw_bg_up);
10750 INIT_WORK(&priv->down, ipw_bg_down);
10751 INIT_DELAYED_WORK(&priv->request_scan, ipw_request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010752 INIT_DELAYED_WORK(&priv->request_direct_scan, ipw_request_direct_scan);
10753 INIT_DELAYED_WORK(&priv->request_passive_scan, ipw_request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010754 INIT_DELAYED_WORK(&priv->scan_event, ipw_scan_event);
David Howellsc4028952006-11-22 14:57:56 +000010755 INIT_DELAYED_WORK(&priv->gather_stats, ipw_bg_gather_stats);
10756 INIT_WORK(&priv->abort_scan, ipw_bg_abort_scan);
10757 INIT_WORK(&priv->roam, ipw_bg_roam);
10758 INIT_DELAYED_WORK(&priv->scan_check, ipw_bg_scan_check);
10759 INIT_WORK(&priv->link_up, ipw_bg_link_up);
10760 INIT_WORK(&priv->link_down, ipw_bg_link_down);
10761 INIT_DELAYED_WORK(&priv->led_link_on, ipw_bg_led_link_on);
10762 INIT_DELAYED_WORK(&priv->led_link_off, ipw_bg_led_link_off);
10763 INIT_DELAYED_WORK(&priv->led_act_off, ipw_bg_led_activity_off);
10764 INIT_WORK(&priv->merge_networks, ipw_merge_adhoc_network);
James Ketrenos43f66a62005-03-25 12:31:53 -060010765
Zhu Yie43e3c12006-04-13 17:20:45 +080010766#ifdef CONFIG_IPW2200_QOS
David Howellsc4028952006-11-22 14:57:56 +000010767 INIT_WORK(&priv->qos_activate, ipw_bg_qos_activate);
Zhu Yie43e3c12006-04-13 17:20:45 +080010768#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010769
10770 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10771 ipw_irq_tasklet, (unsigned long)priv);
10772
10773 return ret;
10774}
10775
James Ketrenos43f66a62005-03-25 12:31:53 -060010776static void shim__set_security(struct net_device *dev,
10777 struct ieee80211_security *sec)
10778{
10779 struct ipw_priv *priv = ieee80211_priv(dev);
10780 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010781 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010782 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010783 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010784 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010785 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010786 priv->ieee->sec.flags &= ~(1 << i);
10787 else {
10788 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010789 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010790 priv->ieee->sec.flags |= (1 << i);
10791 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010792 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010793 } else if (sec->level != SEC_LEVEL_1)
10794 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010795 }
10796
James Ketrenosb095c382005-08-24 22:04:42 -050010797 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010798 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010799 priv->ieee->sec.active_key = sec->active_key;
10800 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010801 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010802 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010803 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010804 } else
10805 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010806
10807 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010808 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10809 priv->ieee->sec.auth_mode = sec->auth_mode;
10810 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010811 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10812 priv->capability |= CAP_SHARED_KEY;
10813 else
10814 priv->capability &= ~CAP_SHARED_KEY;
10815 priv->status |= STATUS_SECURITY_UPDATED;
10816 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010817
James Ketrenosb095c382005-08-24 22:04:42 -050010818 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10819 priv->ieee->sec.flags |= SEC_ENABLED;
10820 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010821 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010822 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010823 priv->capability |= CAP_PRIVACY_ON;
10824 else
10825 priv->capability &= ~CAP_PRIVACY_ON;
10826 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010827
James Ketrenosafbf30a2005-08-25 00:05:33 -050010828 if (sec->flags & SEC_ENCRYPT)
10829 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010830
James Ketrenosb095c382005-08-24 22:04:42 -050010831 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10832 priv->ieee->sec.level = sec->level;
10833 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010834 priv->status |= STATUS_SECURITY_UPDATED;
10835 }
10836
Zhu Yi1fbfea52005-08-05 17:22:56 +080010837 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10838 ipw_set_hwcrypto_keys(priv);
10839
Jeff Garzikbf794512005-07-31 13:07:26 -040010840 /* To match current functionality of ipw2100 (which works well w/
10841 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010842 * privacy capability changes ... */
10843#if 0
10844 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010845 (((priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010846 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010847 (!(priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010848 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010849 IPW_DEBUG_ASSOC("Disassociating due to capability "
10850 "change.\n");
10851 ipw_disassociate(priv);
10852 }
10853#endif
10854}
10855
Jeff Garzikbf794512005-07-31 13:07:26 -040010856static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010857 struct ipw_supported_rates *rates)
10858{
10859 /* TODO: Mask out rates based on priv->rates_mask */
10860
10861 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010862 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010863 switch (priv->ieee->freq_band) {
10864 case IEEE80211_52GHZ_BAND:
10865 rates->ieee_mode = IPW_A_MODE;
10866 rates->purpose = IPW_RATE_CAPABILITIES;
10867 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10868 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10869 break;
10870
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010871 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010872 rates->ieee_mode = IPW_G_MODE;
10873 rates->purpose = IPW_RATE_CAPABILITIES;
10874 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10875 IEEE80211_CCK_DEFAULT_RATES_MASK);
10876 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10877 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10878 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10879 }
10880 break;
10881 }
10882
10883 return 0;
10884}
10885
Jeff Garzikbf794512005-07-31 13:07:26 -040010886static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010887{
James Ketrenos43f66a62005-03-25 12:31:53 -060010888 /* This is only called from ipw_up, which resets/reloads the firmware
10889 so, we don't need to first disable the card before we configure
10890 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010891 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010892 goto error;
10893
10894 /* initialize adapter address */
10895 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10896 goto error;
10897
10898 /* set basic system config settings */
10899 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010900
10901 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10902 * Does not support BT priority yet (don't abort or defer our Tx) */
10903 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010904 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010905
10906 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10907 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010908 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010909 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10910 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010911 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010912 }
10913
Zhu Yid685b8c2006-04-13 17:20:27 +080010914#ifdef CONFIG_IPW2200_PROMISCUOUS
10915 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10916 priv->sys_config.accept_all_data_frames = 1;
10917 priv->sys_config.accept_non_directed_frames = 1;
10918 priv->sys_config.accept_all_mgmt_bcpr = 1;
10919 priv->sys_config.accept_all_mgmt_frames = 1;
10920 }
10921#endif
10922
James Ketrenosc848d0a2005-08-24 21:56:24 -050010923 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10924 priv->sys_config.answer_broadcast_ssid_probe = 1;
10925 else
10926 priv->sys_config.answer_broadcast_ssid_probe = 0;
10927
Zhu Yid685b8c2006-04-13 17:20:27 +080010928 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010929 goto error;
10930
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010931 init_supported_rates(priv, &priv->rates);
10932 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010933 goto error;
10934
10935 /* Set request-to-send threshold */
10936 if (priv->rts_threshold) {
10937 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10938 goto error;
10939 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010940#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010941 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10942 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010943#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010944
10945 if (ipw_set_random_seed(priv))
10946 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010947
James Ketrenos43f66a62005-03-25 12:31:53 -060010948 /* final state transition to the RUN state */
10949 if (ipw_send_host_complete(priv))
10950 goto error;
10951
James Ketrenose6666192005-08-12 09:17:04 -050010952 priv->status |= STATUS_INIT;
10953
10954 ipw_led_init(priv);
10955 ipw_led_radio_on(priv);
10956 priv->notif_missed_beacons = 0;
10957
10958 /* Set hardware WEP key if it is configured. */
10959 if ((priv->capability & CAP_PRIVACY_ON) &&
10960 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10961 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10962 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010963
10964 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010965
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010966 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010967 return -EIO;
10968}
10969
James Ketrenos4f36f802005-08-03 20:36:56 -050010970/*
10971 * NOTE:
10972 *
10973 * These tables have been tested in conjunction with the
10974 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
10975 *
10976 * Altering this values, using it on other hardware, or in geographies
10977 * not intended for resale of the above mentioned Intel adapters has
10978 * not been tested.
10979 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080010980 * Remember to update the table in README.ipw2200 when changing this
10981 * table.
10982 *
James Ketrenos4f36f802005-08-03 20:36:56 -050010983 */
10984static const struct ieee80211_geo ipw_geos[] = {
10985 { /* Restricted */
10986 "---",
10987 .bg_channels = 11,
10988 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10989 {2427, 4}, {2432, 5}, {2437, 6},
10990 {2442, 7}, {2447, 8}, {2452, 9},
10991 {2457, 10}, {2462, 11}},
10992 },
10993
10994 { /* Custom US/Canada */
10995 "ZZF",
10996 .bg_channels = 11,
10997 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10998 {2427, 4}, {2432, 5}, {2437, 6},
10999 {2442, 7}, {2447, 8}, {2452, 9},
11000 {2457, 10}, {2462, 11}},
11001 .a_channels = 8,
11002 .a = {{5180, 36},
11003 {5200, 40},
11004 {5220, 44},
11005 {5240, 48},
11006 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11007 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11008 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11009 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
11010 },
11011
11012 { /* Rest of World */
11013 "ZZD",
11014 .bg_channels = 13,
11015 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11016 {2427, 4}, {2432, 5}, {2437, 6},
11017 {2442, 7}, {2447, 8}, {2452, 9},
11018 {2457, 10}, {2462, 11}, {2467, 12},
11019 {2472, 13}},
11020 },
11021
11022 { /* Custom USA & Europe & High */
11023 "ZZA",
11024 .bg_channels = 11,
11025 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11026 {2427, 4}, {2432, 5}, {2437, 6},
11027 {2442, 7}, {2447, 8}, {2452, 9},
11028 {2457, 10}, {2462, 11}},
11029 .a_channels = 13,
11030 .a = {{5180, 36},
11031 {5200, 40},
11032 {5220, 44},
11033 {5240, 48},
11034 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11035 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11036 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11037 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11038 {5745, 149},
11039 {5765, 153},
11040 {5785, 157},
11041 {5805, 161},
11042 {5825, 165}},
11043 },
11044
11045 { /* Custom NA & Europe */
11046 "ZZB",
11047 .bg_channels = 11,
11048 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11049 {2427, 4}, {2432, 5}, {2437, 6},
11050 {2442, 7}, {2447, 8}, {2452, 9},
11051 {2457, 10}, {2462, 11}},
11052 .a_channels = 13,
11053 .a = {{5180, 36},
11054 {5200, 40},
11055 {5220, 44},
11056 {5240, 48},
11057 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11058 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11059 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11060 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11061 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11062 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11063 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11064 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11065 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11066 },
11067
11068 { /* Custom Japan */
11069 "ZZC",
11070 .bg_channels = 11,
11071 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11072 {2427, 4}, {2432, 5}, {2437, 6},
11073 {2442, 7}, {2447, 8}, {2452, 9},
11074 {2457, 10}, {2462, 11}},
11075 .a_channels = 4,
11076 .a = {{5170, 34}, {5190, 38},
11077 {5210, 42}, {5230, 46}},
11078 },
11079
11080 { /* Custom */
11081 "ZZM",
11082 .bg_channels = 11,
11083 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11084 {2427, 4}, {2432, 5}, {2437, 6},
11085 {2442, 7}, {2447, 8}, {2452, 9},
11086 {2457, 10}, {2462, 11}},
11087 },
11088
11089 { /* Europe */
11090 "ZZE",
11091 .bg_channels = 13,
11092 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11093 {2427, 4}, {2432, 5}, {2437, 6},
11094 {2442, 7}, {2447, 8}, {2452, 9},
11095 {2457, 10}, {2462, 11}, {2467, 12},
11096 {2472, 13}},
11097 .a_channels = 19,
11098 .a = {{5180, 36},
11099 {5200, 40},
11100 {5220, 44},
11101 {5240, 48},
11102 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11103 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11104 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11105 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11106 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11107 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11108 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11109 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11110 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11111 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11112 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11113 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11114 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11115 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11116 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11117 },
11118
11119 { /* Custom Japan */
11120 "ZZJ",
11121 .bg_channels = 14,
11122 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11123 {2427, 4}, {2432, 5}, {2437, 6},
11124 {2442, 7}, {2447, 8}, {2452, 9},
11125 {2457, 10}, {2462, 11}, {2467, 12},
11126 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11127 .a_channels = 4,
11128 .a = {{5170, 34}, {5190, 38},
11129 {5210, 42}, {5230, 46}},
11130 },
11131
James Ketrenos03520572005-10-19 16:12:31 -050011132 { /* Rest of World */
11133 "ZZR",
11134 .bg_channels = 14,
11135 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11136 {2427, 4}, {2432, 5}, {2437, 6},
11137 {2442, 7}, {2447, 8}, {2452, 9},
11138 {2457, 10}, {2462, 11}, {2467, 12},
11139 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11140 IEEE80211_CH_PASSIVE_ONLY}},
11141 },
11142
James Ketrenos4f36f802005-08-03 20:36:56 -050011143 { /* High Band */
11144 "ZZH",
11145 .bg_channels = 13,
11146 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11147 {2427, 4}, {2432, 5}, {2437, 6},
11148 {2442, 7}, {2447, 8}, {2452, 9},
11149 {2457, 10}, {2462, 11},
11150 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11151 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11152 .a_channels = 4,
11153 .a = {{5745, 149}, {5765, 153},
11154 {5785, 157}, {5805, 161}},
11155 },
11156
11157 { /* Custom Europe */
11158 "ZZG",
11159 .bg_channels = 13,
11160 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11161 {2427, 4}, {2432, 5}, {2437, 6},
11162 {2442, 7}, {2447, 8}, {2452, 9},
11163 {2457, 10}, {2462, 11},
11164 {2467, 12}, {2472, 13}},
11165 .a_channels = 4,
11166 .a = {{5180, 36}, {5200, 40},
11167 {5220, 44}, {5240, 48}},
11168 },
11169
11170 { /* Europe */
11171 "ZZK",
11172 .bg_channels = 13,
11173 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11174 {2427, 4}, {2432, 5}, {2437, 6},
11175 {2442, 7}, {2447, 8}, {2452, 9},
11176 {2457, 10}, {2462, 11},
11177 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11178 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11179 .a_channels = 24,
11180 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11181 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11182 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11183 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11184 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11185 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11186 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11187 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11188 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11189 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11190 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11191 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11192 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11193 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11194 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11195 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11196 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11197 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11198 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11199 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11200 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11201 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11202 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11203 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11204 },
11205
11206 { /* Europe */
11207 "ZZL",
11208 .bg_channels = 11,
11209 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11210 {2427, 4}, {2432, 5}, {2437, 6},
11211 {2442, 7}, {2447, 8}, {2452, 9},
11212 {2457, 10}, {2462, 11}},
11213 .a_channels = 13,
11214 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11215 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11216 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11217 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11218 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11219 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11220 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11221 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11222 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11223 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11224 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11225 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11226 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11227 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011228};
11229
James Ketrenos43f66a62005-03-25 12:31:53 -060011230#define MAX_HW_RESTARTS 5
11231static int ipw_up(struct ipw_priv *priv)
11232{
James Ketrenos4f36f802005-08-03 20:36:56 -050011233 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011234
Dan Williamsc3d72b92009-02-11 13:26:06 -050011235 /* Age scan list entries found before suspend */
11236 if (priv->suspend_time) {
11237 ieee80211_networks_age(priv->ieee, priv->suspend_time);
11238 priv->suspend_time = 0;
11239 }
11240
James Ketrenos43f66a62005-03-25 12:31:53 -060011241 if (priv->status & STATUS_EXIT_PENDING)
11242 return -EIO;
11243
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011244 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011245 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011246 GFP_KERNEL);
11247 if (priv->cmdlog == NULL) {
11248 IPW_ERROR("Error allocating %d command log entries.\n",
11249 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011250 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011251 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011252 priv->cmdlog_len = cmdlog;
11253 }
11254 }
11255
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011256 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011257 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011258 * Also start the clocks. */
11259 rc = ipw_load(priv);
11260 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011261 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011262 return rc;
11263 }
11264
11265 ipw_init_ordinals(priv);
11266 if (!(priv->config & CFG_CUSTOM_MAC))
11267 eeprom_parse_mac(priv, priv->mac_addr);
11268 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11269
James Ketrenos4f36f802005-08-03 20:36:56 -050011270 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11271 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11272 ipw_geos[j].name, 3))
11273 break;
11274 }
James Ketrenos03520572005-10-19 16:12:31 -050011275 if (j == ARRAY_SIZE(ipw_geos)) {
11276 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11277 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11278 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11279 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011280 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011281 }
Larry Finger1867b112006-02-28 09:48:28 -060011282 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011283 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011284 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011285 }
11286
James Ketrenosb095c382005-08-24 22:04:42 -050011287 if (priv->status & STATUS_RF_KILL_SW) {
11288 IPW_WARNING("Radio disabled by module parameter.\n");
11289 return 0;
11290 } else if (rf_kill_active(priv)) {
11291 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11292 "Kill switch must be turned off for "
11293 "wireless networking to work.\n");
11294 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11295 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011296 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011297 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011298
11299 rc = ipw_config(priv);
11300 if (!rc) {
11301 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011302
James Ketrenose6666192005-08-12 09:17:04 -050011303 /* If configure to try and auto-associate, kick
11304 * off a scan. */
David Howellsc4028952006-11-22 14:57:56 +000011305 queue_delayed_work(priv->workqueue,
11306 &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011307
James Ketrenos43f66a62005-03-25 12:31:53 -060011308 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011309 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011310
James Ketrenosc848d0a2005-08-24 21:56:24 -050011311 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011312 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11313 i, MAX_HW_RESTARTS);
11314
11315 /* We had an error bringing up the hardware, so take it
11316 * all the way back down so we can try again */
11317 ipw_down(priv);
11318 }
11319
Jeff Garzikbf794512005-07-31 13:07:26 -040011320 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011321 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011322 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011323
James Ketrenos43f66a62005-03-25 12:31:53 -060011324 return -EIO;
11325}
11326
David Howellsc4028952006-11-22 14:57:56 +000011327static void ipw_bg_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011328{
David Howellsc4028952006-11-22 14:57:56 +000011329 struct ipw_priv *priv =
11330 container_of(work, struct ipw_priv, up);
Zhu Yi46441512006-01-24 16:37:59 +080011331 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011332 ipw_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011333 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011334}
11335
James Ketrenosb095c382005-08-24 22:04:42 -050011336static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011337{
James Ketrenosb095c382005-08-24 22:04:42 -050011338 int i;
11339
11340 if (priv->status & STATUS_SCANNING) {
11341 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11342 ipw_abort_scan(priv);
11343 }
11344
11345 if (priv->status & STATUS_ASSOCIATED) {
11346 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11347 ipw_disassociate(priv);
11348 }
11349
11350 ipw_led_shutdown(priv);
11351
11352 /* Wait up to 1s for status to change to not scanning and not
11353 * associated (disassociation can take a while for a ful 802.11
11354 * exchange */
11355 for (i = 1000; i && (priv->status &
11356 (STATUS_DISASSOCIATING |
11357 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11358 udelay(10);
11359
11360 if (priv->status & (STATUS_DISASSOCIATING |
11361 STATUS_ASSOCIATED | STATUS_SCANNING))
11362 IPW_DEBUG_INFO("Still associated or scanning...\n");
11363 else
11364 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11365
James Ketrenosc848d0a2005-08-24 21:56:24 -050011366 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011367 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011368
11369 priv->status &= ~STATUS_INIT;
11370}
11371
James Ketrenos43f66a62005-03-25 12:31:53 -060011372static void ipw_down(struct ipw_priv *priv)
11373{
James Ketrenosb095c382005-08-24 22:04:42 -050011374 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11375
11376 priv->status |= STATUS_EXIT_PENDING;
11377
11378 if (ipw_is_init(priv))
11379 ipw_deinit(priv);
11380
11381 /* Wipe out the EXIT_PENDING status bit if we are not actually
11382 * exiting the module */
11383 if (!exit_pending)
11384 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011385
11386 /* tell the device to stop sending interrupts */
11387 ipw_disable_interrupts(priv);
11388
11389 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011390 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011391 netif_carrier_off(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011392
11393 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011394
11395 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011396}
11397
David Howellsc4028952006-11-22 14:57:56 +000011398static void ipw_bg_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011399{
David Howellsc4028952006-11-22 14:57:56 +000011400 struct ipw_priv *priv =
11401 container_of(work, struct ipw_priv, down);
Zhu Yi46441512006-01-24 16:37:59 +080011402 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011403 ipw_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011404 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011405}
11406
11407/* Called by register_netdev() */
11408static int ipw_net_init(struct net_device *dev)
11409{
11410 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011411 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011412
James Ketrenosc848d0a2005-08-24 21:56:24 -050011413 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011414 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011415 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011416 }
11417
Zhu Yi46441512006-01-24 16:37:59 +080011418 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011419 return 0;
11420}
11421
11422/* PCI driver stuff */
11423static struct pci_device_id card_ids[] = {
11424 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11425 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11426 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11427 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11428 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11429 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11430 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11431 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11432 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11433 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11434 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11435 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11436 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11437 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11438 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11439 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11440 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11441 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011442 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011443 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011444 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11445 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011446
James Ketrenos43f66a62005-03-25 12:31:53 -060011447 /* required last entry */
11448 {0,}
11449};
11450
11451MODULE_DEVICE_TABLE(pci, card_ids);
11452
11453static struct attribute *ipw_sysfs_entries[] = {
11454 &dev_attr_rf_kill.attr,
11455 &dev_attr_direct_dword.attr,
11456 &dev_attr_indirect_byte.attr,
11457 &dev_attr_indirect_dword.attr,
11458 &dev_attr_mem_gpio_reg.attr,
11459 &dev_attr_command_event_reg.attr,
11460 &dev_attr_nic_type.attr,
11461 &dev_attr_status.attr,
11462 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011463 &dev_attr_error.attr,
11464 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011465 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011466 &dev_attr_eeprom_delay.attr,
11467 &dev_attr_ucode_version.attr,
11468 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011469 &dev_attr_scan_age.attr,
11470 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011471 &dev_attr_speed_scan.attr,
11472 &dev_attr_net_stats.attr,
Zhu Yi375dd242007-02-14 16:04:24 +080011473 &dev_attr_channels.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011474#ifdef CONFIG_IPW2200_PROMISCUOUS
11475 &dev_attr_rtap_iface.attr,
11476 &dev_attr_rtap_filter.attr,
11477#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011478 NULL
11479};
11480
11481static struct attribute_group ipw_attribute_group = {
11482 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011483 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011484};
11485
Zhu Yid685b8c2006-04-13 17:20:27 +080011486#ifdef CONFIG_IPW2200_PROMISCUOUS
11487static int ipw_prom_open(struct net_device *dev)
11488{
11489 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11490 struct ipw_priv *priv = prom_priv->priv;
11491
11492 IPW_DEBUG_INFO("prom dev->open\n");
11493 netif_carrier_off(dev);
Zhu Yid685b8c2006-04-13 17:20:27 +080011494
11495 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11496 priv->sys_config.accept_all_data_frames = 1;
11497 priv->sys_config.accept_non_directed_frames = 1;
11498 priv->sys_config.accept_all_mgmt_bcpr = 1;
11499 priv->sys_config.accept_all_mgmt_frames = 1;
11500
11501 ipw_send_system_config(priv);
11502 }
11503
11504 return 0;
11505}
11506
11507static int ipw_prom_stop(struct net_device *dev)
11508{
11509 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11510 struct ipw_priv *priv = prom_priv->priv;
11511
11512 IPW_DEBUG_INFO("prom dev->stop\n");
11513
11514 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11515 priv->sys_config.accept_all_data_frames = 0;
11516 priv->sys_config.accept_non_directed_frames = 0;
11517 priv->sys_config.accept_all_mgmt_bcpr = 0;
11518 priv->sys_config.accept_all_mgmt_frames = 0;
11519
11520 ipw_send_system_config(priv);
11521 }
11522
11523 return 0;
11524}
11525
11526static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11527{
11528 IPW_DEBUG_INFO("prom dev->xmit\n");
Zhu Yid685b8c2006-04-13 17:20:27 +080011529 return -EOPNOTSUPP;
11530}
11531
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011532static const struct net_device_ops ipw_prom_netdev_ops = {
11533 .ndo_open = ipw_prom_open,
11534 .ndo_stop = ipw_prom_stop,
11535 .ndo_start_xmit = ipw_prom_hard_start_xmit,
11536 .ndo_change_mtu = ieee80211_change_mtu,
11537 .ndo_set_mac_address = eth_mac_addr,
11538 .ndo_validate_addr = eth_validate_addr,
11539};
11540
Zhu Yid685b8c2006-04-13 17:20:27 +080011541static int ipw_prom_alloc(struct ipw_priv *priv)
11542{
11543 int rc = 0;
11544
11545 if (priv->prom_net_dev)
11546 return -EPERM;
11547
11548 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11549 if (priv->prom_net_dev == NULL)
11550 return -ENOMEM;
11551
11552 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11553 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11554 priv->prom_priv->priv = priv;
11555
11556 strcpy(priv->prom_net_dev->name, "rtap%d");
Daniel Drake3f2eeac2008-04-02 20:33:54 +010011557 memcpy(priv->prom_net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
Zhu Yid685b8c2006-04-13 17:20:27 +080011558
11559 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011560 priv->prom_net_dev->netdev_ops = &ipw_prom_netdev_ops;
Zhu Yid685b8c2006-04-13 17:20:27 +080011561
11562 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
Masakazu Mokuno229ce3a2008-05-14 14:16:50 +090011563 SET_NETDEV_DEV(priv->prom_net_dev, &priv->pci_dev->dev);
Zhu Yid685b8c2006-04-13 17:20:27 +080011564
11565 rc = register_netdev(priv->prom_net_dev);
11566 if (rc) {
11567 free_ieee80211(priv->prom_net_dev);
11568 priv->prom_net_dev = NULL;
11569 return rc;
11570 }
11571
11572 return 0;
11573}
11574
11575static void ipw_prom_free(struct ipw_priv *priv)
11576{
11577 if (!priv->prom_net_dev)
11578 return;
11579
11580 unregister_netdev(priv->prom_net_dev);
11581 free_ieee80211(priv->prom_net_dev);
11582
11583 priv->prom_net_dev = NULL;
11584}
11585
11586#endif
11587
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011588static const struct net_device_ops ipw_netdev_ops = {
11589 .ndo_init = ipw_net_init,
11590 .ndo_open = ipw_net_open,
11591 .ndo_stop = ipw_net_stop,
11592 .ndo_set_multicast_list = ipw_net_set_multicast_list,
11593 .ndo_set_mac_address = ipw_net_set_mac_address,
11594 .ndo_start_xmit = ieee80211_xmit,
11595 .ndo_change_mtu = ieee80211_change_mtu,
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011596 .ndo_validate_addr = eth_validate_addr,
11597};
Zhu Yid685b8c2006-04-13 17:20:27 +080011598
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011599static int __devinit ipw_pci_probe(struct pci_dev *pdev,
11600 const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011601{
11602 int err = 0;
11603 struct net_device *net_dev;
11604 void __iomem *base;
11605 u32 length, val;
11606 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011607 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011608
11609 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11610 if (net_dev == NULL) {
11611 err = -ENOMEM;
11612 goto out;
11613 }
11614
11615 priv = ieee80211_priv(net_dev);
11616 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011617
James Ketrenos43f66a62005-03-25 12:31:53 -060011618 priv->net_dev = net_dev;
11619 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011620 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011621 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011622 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011623 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11624 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011625
Zhu Yi46441512006-01-24 16:37:59 +080011626 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011627 if (pci_enable_device(pdev)) {
11628 err = -ENODEV;
11629 goto out_free_ieee80211;
11630 }
11631
11632 pci_set_master(pdev);
11633
Tobias Klauser0e08b442005-06-20 14:28:41 -070011634 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011635 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011636 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011637 if (err) {
11638 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11639 goto out_pci_disable_device;
11640 }
11641
11642 pci_set_drvdata(pdev, priv);
11643
11644 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011645 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011646 goto out_pci_disable_device;
11647
Jeff Garzikbf794512005-07-31 13:07:26 -040011648 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011649 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011650 pci_read_config_dword(pdev, 0x40, &val);
11651 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011652 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011653
James Ketrenos43f66a62005-03-25 12:31:53 -060011654 length = pci_resource_len(pdev, 0);
11655 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011656
Arjan van de Ven275f1652008-10-20 21:42:39 -070011657 base = pci_ioremap_bar(pdev, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -060011658 if (!base) {
11659 err = -ENODEV;
11660 goto out_pci_release_regions;
11661 }
11662
11663 priv->hw_base = base;
11664 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11665 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11666
11667 err = ipw_setup_deferred_work(priv);
11668 if (err) {
11669 IPW_ERROR("Unable to setup deferred work\n");
11670 goto out_iounmap;
11671 }
11672
James Ketrenosb095c382005-08-24 22:04:42 -050011673 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011674
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011675 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011676 if (err) {
11677 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11678 goto out_destroy_workqueue;
11679 }
11680
James Ketrenos43f66a62005-03-25 12:31:53 -060011681 SET_NETDEV_DEV(net_dev, &pdev->dev);
11682
Zhu Yi46441512006-01-24 16:37:59 +080011683 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011684
James Ketrenos43f66a62005-03-25 12:31:53 -060011685 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11686 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011687 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011688
Zhu Yie43e3c12006-04-13 17:20:45 +080011689#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011690 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011691 priv->ieee->handle_probe_response = ipw_handle_beacon;
11692 priv->ieee->handle_beacon = ipw_handle_probe_response;
11693 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011694#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011695
James Ketrenosc848d0a2005-08-24 21:56:24 -050011696 priv->ieee->perfect_rssi = -20;
11697 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011698
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011699 net_dev->netdev_ops = &ipw_netdev_ops;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011700 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011701 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011702 net_dev->wireless_handlers = &ipw_wx_handler_def;
11703 net_dev->ethtool_ops = &ipw_ethtool_ops;
11704 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011705 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011706 net_dev->mem_start = pci_resource_start(pdev, 0);
11707 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11708
11709 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11710 if (err) {
11711 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011712 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011713 goto out_release_irq;
11714 }
11715
Zhu Yi46441512006-01-24 16:37:59 +080011716 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011717 err = register_netdev(net_dev);
11718 if (err) {
11719 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011720 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011721 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011722
Zhu Yid685b8c2006-04-13 17:20:27 +080011723#ifdef CONFIG_IPW2200_PROMISCUOUS
11724 if (rtap_iface) {
11725 err = ipw_prom_alloc(priv);
11726 if (err) {
11727 IPW_ERROR("Failed to register promiscuous network "
11728 "device (error %d).\n", err);
11729 unregister_netdev(priv->net_dev);
11730 goto out_remove_sysfs;
11731 }
11732 }
11733#endif
11734
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011735 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11736 "channels, %d 802.11a channels)\n",
11737 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11738 priv->ieee->geo.a_channels);
11739
James Ketrenos43f66a62005-03-25 12:31:53 -060011740 return 0;
11741
James Ketrenosa613bff2005-08-24 21:43:11 -050011742 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011743 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011744 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011745 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011746 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011747 destroy_workqueue(priv->workqueue);
11748 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011749 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011750 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011751 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011752 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011753 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011754 pci_disable_device(pdev);
11755 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011756 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011757 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011758 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011759 return err;
11760}
11761
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011762static void __devexit ipw_pci_remove(struct pci_dev *pdev)
James Ketrenos43f66a62005-03-25 12:31:53 -060011763{
11764 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011765 struct list_head *p, *q;
11766 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011767
James Ketrenos43f66a62005-03-25 12:31:53 -060011768 if (!priv)
11769 return;
11770
Zhu Yi46441512006-01-24 16:37:59 +080011771 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011772
James Ketrenosafbf30a2005-08-25 00:05:33 -050011773 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011774 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011775 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11776
Zhu Yi46441512006-01-24 16:37:59 +080011777 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011778
11779 unregister_netdev(priv->net_dev);
11780
11781 if (priv->rxq) {
11782 ipw_rx_queue_free(priv, priv->rxq);
11783 priv->rxq = NULL;
11784 }
11785 ipw_tx_queue_free(priv);
11786
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011787 if (priv->cmdlog) {
11788 kfree(priv->cmdlog);
11789 priv->cmdlog = NULL;
11790 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011791 /* ipw_down will ensure that there is no more pending work
11792 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011793 cancel_delayed_work(&priv->adhoc_check);
11794 cancel_delayed_work(&priv->gather_stats);
11795 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040011796 cancel_delayed_work(&priv->request_direct_scan);
11797 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040011798 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050011799 cancel_delayed_work(&priv->rf_kill);
11800 cancel_delayed_work(&priv->scan_check);
11801 destroy_workqueue(priv->workqueue);
11802 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011803
James Ketrenosafbf30a2005-08-25 00:05:33 -050011804 /* Free MAC hash list for ADHOC */
11805 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11806 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011807 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011808 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011809 }
11810 }
11811
Jesper Juhl8f760782006-06-27 02:55:06 -070011812 kfree(priv->error);
11813 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011814
Zhu Yid685b8c2006-04-13 17:20:27 +080011815#ifdef CONFIG_IPW2200_PROMISCUOUS
11816 ipw_prom_free(priv);
11817#endif
11818
James Ketrenos43f66a62005-03-25 12:31:53 -060011819 free_irq(pdev->irq, priv);
11820 iounmap(priv->hw_base);
11821 pci_release_regions(pdev);
11822 pci_disable_device(pdev);
11823 pci_set_drvdata(pdev, NULL);
11824 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011825 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011826}
11827
James Ketrenos43f66a62005-03-25 12:31:53 -060011828#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011829static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011830{
11831 struct ipw_priv *priv = pci_get_drvdata(pdev);
11832 struct net_device *dev = priv->net_dev;
11833
11834 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11835
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011836 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011837 ipw_down(priv);
11838
11839 /* Remove the PRESENT state of the device */
11840 netif_device_detach(dev);
11841
James Ketrenos43f66a62005-03-25 12:31:53 -060011842 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011843 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011844 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011845
Dan Williamsc3d72b92009-02-11 13:26:06 -050011846 priv->suspend_at = get_seconds();
11847
James Ketrenos43f66a62005-03-25 12:31:53 -060011848 return 0;
11849}
11850
11851static int ipw_pci_resume(struct pci_dev *pdev)
11852{
11853 struct ipw_priv *priv = pci_get_drvdata(pdev);
11854 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011855 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011856 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011857
James Ketrenos43f66a62005-03-25 12:31:53 -060011858 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11859
James Ketrenosea2b26e2005-08-24 21:25:16 -050011860 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011861 err = pci_enable_device(pdev);
11862 if (err) {
11863 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11864 dev->name);
11865 return err;
11866 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011867 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011868
James Ketrenos43f66a62005-03-25 12:31:53 -060011869 /*
11870 * Suspend/Resume resets the PCI configuration space, so we have to
11871 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11872 * from interfering with C3 CPU state. pci_restore_state won't help
11873 * here since it only restores the first 64 bytes pci config header.
11874 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011875 pci_read_config_dword(pdev, 0x40, &val);
11876 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011877 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11878
11879 /* Set the device back into the PRESENT state; this will also wake
11880 * the queue of needed */
11881 netif_device_attach(dev);
11882
Dan Williamsc3d72b92009-02-11 13:26:06 -050011883 priv->suspend_time = get_seconds() - priv->suspend_at;
11884
James Ketrenos43f66a62005-03-25 12:31:53 -060011885 /* Bring the device back up */
11886 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011887
James Ketrenos43f66a62005-03-25 12:31:53 -060011888 return 0;
11889}
11890#endif
11891
Zhu Yic8c22c92006-08-21 11:38:39 +080011892static void ipw_pci_shutdown(struct pci_dev *pdev)
11893{
11894 struct ipw_priv *priv = pci_get_drvdata(pdev);
11895
11896 /* Take down the device; powers it off, etc. */
11897 ipw_down(priv);
11898
11899 pci_disable_device(pdev);
11900}
11901
James Ketrenos43f66a62005-03-25 12:31:53 -060011902/* driver initialization stuff */
11903static struct pci_driver ipw_driver = {
11904 .name = DRV_NAME,
11905 .id_table = card_ids,
11906 .probe = ipw_pci_probe,
11907 .remove = __devexit_p(ipw_pci_remove),
11908#ifdef CONFIG_PM
11909 .suspend = ipw_pci_suspend,
11910 .resume = ipw_pci_resume,
11911#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011912 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011913};
11914
11915static int __init ipw_init(void)
11916{
11917 int ret;
11918
11919 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11920 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11921
Jeff Garzik29917622006-08-19 17:48:59 -040011922 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011923 if (ret) {
11924 IPW_ERROR("Unable to initialize PCI module\n");
11925 return ret;
11926 }
11927
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011928 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011929 if (ret) {
11930 IPW_ERROR("Unable to create driver sysfs file\n");
11931 pci_unregister_driver(&ipw_driver);
11932 return ret;
11933 }
11934
11935 return ret;
11936}
11937
11938static void __exit ipw_exit(void)
11939{
11940 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11941 pci_unregister_driver(&ipw_driver);
11942}
11943
11944module_param(disable, int, 0444);
11945MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11946
11947module_param(associate, int, 0444);
Tim Gardner5c7f9b72008-10-14 10:38:03 -060011948MODULE_PARM_DESC(associate, "auto associate when scanning (default off)");
James Ketrenos43f66a62005-03-25 12:31:53 -060011949
11950module_param(auto_create, int, 0444);
11951MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11952
James Ketrenosa613bff2005-08-24 21:43:11 -050011953module_param(led, int, 0444);
Niels de Vos61a2d072008-07-31 00:07:23 -070011954MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)");
James Ketrenosa613bff2005-08-24 21:43:11 -050011955
James Ketrenos43f66a62005-03-25 12:31:53 -060011956module_param(debug, int, 0444);
11957MODULE_PARM_DESC(debug, "debug output mask");
11958
11959module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011960MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011961
Zhu Yid685b8c2006-04-13 17:20:27 +080011962#ifdef CONFIG_IPW2200_PROMISCUOUS
11963module_param(rtap_iface, int, 0444);
11964MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11965#endif
11966
Zhu Yie43e3c12006-04-13 17:20:45 +080011967#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011968module_param(qos_enable, int, 0444);
11969MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011970
James Ketrenosb095c382005-08-24 22:04:42 -050011971module_param(qos_burst_enable, int, 0444);
11972MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11973
11974module_param(qos_no_ack_mask, int, 0444);
11975MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11976
11977module_param(burst_duration_CCK, int, 0444);
11978MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11979
11980module_param(burst_duration_OFDM, int, 0444);
11981MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011982#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011983
11984#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060011985module_param(mode, int, 0444);
11986MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
11987#else
11988module_param(mode, int, 0444);
11989MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
11990#endif
11991
Zhu Yi810dabd2006-01-24 16:36:59 +080011992module_param(bt_coexist, int, 0444);
11993MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
11994
James Ketrenosb095c382005-08-24 22:04:42 -050011995module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080011996MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050011997
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011998module_param(cmdlog, int, 0444);
11999MODULE_PARM_DESC(cmdlog,
12000 "allocate a ring buffer for logging firmware commands");
12001
Zhu Yi4bfdb912006-01-24 16:37:16 +080012002module_param(roaming, int, 0444);
12003MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
12004
Zhu Yid2b83e12006-04-13 17:19:36 +080012005module_param(antenna, int, 0444);
12006MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
12007
James Ketrenos43f66a62005-03-25 12:31:53 -060012008module_exit(ipw_exit);
12009module_init(ipw_init);