blob: 8e18d5348350028db3e8c6821e12ad4be13da9d2 [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;
Reinette Chatre21f8a732009-08-18 10:25:05 -070086static int default_channel = 0;
87static int network_mode = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060088
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;
Reinette Chatre21f8a732009-08-18 10:25:05 -070092static int led_support = 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{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001530 struct ipw_priv *p = dev_get_drvdata(d);
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{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001539 struct ipw_priv *p = dev_get_drvdata(d);
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{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001548 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosa613bff2005-08-24 21:43:11 -05001549 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;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001558 struct ipw_priv *p = dev_get_drvdata(d);
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;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001572 struct ipw_priv *p = dev_get_drvdata(d);
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{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001589 struct ipw_priv *p = dev_get_drvdata(d);
1590 int n = p->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001591 return sprintf(buf, "%i\n", n);
1592}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001593static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001594 struct device_attribute *attr,
1595 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001596{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001597 struct ipw_priv *p = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001598 sscanf(buf, "%i", &p->eeprom_delay);
1599 return strnlen(buf, count);
1600}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001601
1602static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1603 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001604
Andrew Mortonad3fee52005-06-20 14:30:36 -07001605static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001606 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001607{
1608 u32 reg = 0;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001609 struct ipw_priv *p = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001610
James Ketrenosb095c382005-08-24 22:04:42 -05001611 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001612 return sprintf(buf, "0x%08x\n", reg);
1613}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001614static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001615 struct device_attribute *attr,
1616 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001617{
1618 u32 reg;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001619 struct ipw_priv *p = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001620
1621 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001622 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001623 return strnlen(buf, count);
1624}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001625
1626static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1627 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001628
Andrew Mortonad3fee52005-06-20 14:30:36 -07001629static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001630 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001631{
1632 u32 reg = 0;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001633 struct ipw_priv *p = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001634
1635 reg = ipw_read_reg32(p, 0x301100);
1636 return sprintf(buf, "0x%08x\n", reg);
1637}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001638static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001639 struct device_attribute *attr,
1640 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001641{
1642 u32 reg;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001643 struct ipw_priv *p = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001644
1645 sscanf(buf, "%x", &reg);
1646 ipw_write_reg32(p, 0x301100, reg);
1647 return strnlen(buf, count);
1648}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001649
1650static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1651 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001652
Andrew Mortonad3fee52005-06-20 14:30:36 -07001653static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001654 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001655{
1656 u32 reg = 0;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001657 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001658
Jeff Garzikbf794512005-07-31 13:07:26 -04001659 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001660 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001661 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001662 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001663
James Ketrenos43f66a62005-03-25 12:31:53 -06001664 return sprintf(buf, "0x%08x\n", reg);
1665}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001666static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001667 struct device_attribute *attr,
1668 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001669{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001670 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001671
1672 sscanf(buf, "%x", &priv->indirect_dword);
1673 priv->status |= STATUS_INDIRECT_DWORD;
1674 return strnlen(buf, count);
1675}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001676
1677static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1678 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001679
Andrew Mortonad3fee52005-06-20 14:30:36 -07001680static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001681 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001682{
1683 u8 reg = 0;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001684 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001685
Jeff Garzikbf794512005-07-31 13:07:26 -04001686 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001687 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001688 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001689 reg = 0;
1690
1691 return sprintf(buf, "0x%02x\n", reg);
1692}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001693static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001694 struct device_attribute *attr,
1695 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001696{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001697 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001698
1699 sscanf(buf, "%x", &priv->indirect_byte);
1700 priv->status |= STATUS_INDIRECT_BYTE;
1701 return strnlen(buf, count);
1702}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001703
1704static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001705 show_indirect_byte, store_indirect_byte);
1706
Andrew Mortonad3fee52005-06-20 14:30:36 -07001707static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001708 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001709{
1710 u32 reg = 0;
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001711 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001712
Jeff Garzikbf794512005-07-31 13:07:26 -04001713 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001714 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001715 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001716 reg = 0;
1717
1718 return sprintf(buf, "0x%08x\n", reg);
1719}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001720static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001721 struct device_attribute *attr,
1722 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001723{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001724 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001725
1726 sscanf(buf, "%x", &priv->direct_dword);
1727 priv->status |= STATUS_DIRECT_DWORD;
1728 return strnlen(buf, count);
1729}
James Ketrenos43f66a62005-03-25 12:31:53 -06001730
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001731static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1732 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001733
Arjan van de Ven858119e2006-01-14 13:20:43 -08001734static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001735{
1736 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1737 priv->status |= STATUS_RF_KILL_HW;
1738 else
1739 priv->status &= ~STATUS_RF_KILL_HW;
1740
1741 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1742}
1743
Andrew Mortonad3fee52005-06-20 14:30:36 -07001744static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001745 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001746{
1747 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001748 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001749 2 - HW based RF kill active
1750 3 - Both HW and SW baed RF kill active */
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001751 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenos43f66a62005-03-25 12:31:53 -06001752 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001753 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001754 return sprintf(buf, "%i\n", val);
1755}
1756
1757static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1758{
Jeff Garzikbf794512005-07-31 13:07:26 -04001759 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001760 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001761 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001762
1763 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1764 disable_radio ? "OFF" : "ON");
1765
1766 if (disable_radio) {
1767 priv->status |= STATUS_RF_KILL_SW;
1768
Dan Williams0b531672007-10-09 13:55:24 -04001769 if (priv->workqueue) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001770 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -04001771 cancel_delayed_work(&priv->request_direct_scan);
1772 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -04001773 cancel_delayed_work(&priv->scan_event);
1774 }
James Ketrenos43f66a62005-03-25 12:31:53 -06001775 queue_work(priv->workqueue, &priv->down);
1776 } else {
1777 priv->status &= ~STATUS_RF_KILL_SW;
1778 if (rf_kill_active(priv)) {
1779 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1780 "disabled by HW switch\n");
1781 /* Make sure the RF_KILL check timer is running */
1782 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001783 queue_delayed_work(priv->workqueue, &priv->rf_kill,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05001784 round_jiffies_relative(2 * HZ));
Jeff Garzikbf794512005-07-31 13:07:26 -04001785 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001786 queue_work(priv->workqueue, &priv->up);
1787 }
1788
1789 return 1;
1790}
1791
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001792static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1793 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001794{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001795 struct ipw_priv *priv = dev_get_drvdata(d);
Jeff Garzikbf794512005-07-31 13:07:26 -04001796
James Ketrenos43f66a62005-03-25 12:31:53 -06001797 ipw_radio_kill_sw(priv, buf[0] == '1');
1798
1799 return count;
1800}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001801
1802static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001803
James Ketrenosb095c382005-08-24 22:04:42 -05001804static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1805 char *buf)
1806{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001807 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosb095c382005-08-24 22:04:42 -05001808 int pos = 0, len = 0;
1809 if (priv->config & CFG_SPEED_SCAN) {
1810 while (priv->speed_scan[pos] != 0)
1811 len += sprintf(&buf[len], "%d ",
1812 priv->speed_scan[pos++]);
1813 return len + sprintf(&buf[len], "\n");
1814 }
1815
1816 return sprintf(buf, "0\n");
1817}
1818
1819static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1820 const char *buf, size_t count)
1821{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001822 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosb095c382005-08-24 22:04:42 -05001823 int channel, pos = 0;
1824 const char *p = buf;
1825
1826 /* list of space separated channels to scan, optionally ending with 0 */
1827 while ((channel = simple_strtol(p, NULL, 0))) {
1828 if (pos == MAX_SPEED_SCAN - 1) {
1829 priv->speed_scan[pos] = 0;
1830 break;
1831 }
1832
Larry Finger1867b112006-02-28 09:48:28 -06001833 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001834 priv->speed_scan[pos++] = channel;
1835 else
1836 IPW_WARNING("Skipping invalid channel request: %d\n",
1837 channel);
1838 p = strchr(p, ' ');
1839 if (!p)
1840 break;
1841 while (*p == ' ' || *p == '\t')
1842 p++;
1843 }
1844
1845 if (pos == 0)
1846 priv->config &= ~CFG_SPEED_SCAN;
1847 else {
1848 priv->speed_scan_pos = 0;
1849 priv->config |= CFG_SPEED_SCAN;
1850 }
1851
1852 return count;
1853}
1854
1855static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1856 store_speed_scan);
1857
1858static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1859 char *buf)
1860{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001861 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosb095c382005-08-24 22:04:42 -05001862 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1863}
1864
1865static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1866 const char *buf, size_t count)
1867{
Greg Kroah-Hartman928841b2009-04-30 23:02:47 -07001868 struct ipw_priv *priv = dev_get_drvdata(d);
James Ketrenosb095c382005-08-24 22:04:42 -05001869 if (buf[0] == '1')
1870 priv->config |= CFG_NET_STATS;
1871 else
1872 priv->config &= ~CFG_NET_STATS;
1873
1874 return count;
1875}
1876
James Ketrenosafbf30a2005-08-25 00:05:33 -05001877static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1878 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001879
Zhu Yi375dd242007-02-14 16:04:24 +08001880static ssize_t show_channels(struct device *d,
1881 struct device_attribute *attr,
1882 char *buf)
1883{
1884 struct ipw_priv *priv = dev_get_drvdata(d);
Andrew Morton742e9912007-03-01 08:19:29 -05001885 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi375dd242007-02-14 16:04:24 +08001886 int len = 0, i;
1887
1888 len = sprintf(&buf[len],
1889 "Displaying %d channels in 2.4Ghz band "
1890 "(802.11bg):\n", geo->bg_channels);
1891
1892 for (i = 0; i < geo->bg_channels; i++) {
1893 len += sprintf(&buf[len], "%d: BSS%s%s, %s, Band %s.\n",
1894 geo->bg[i].channel,
1895 geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT ?
1896 " (radar spectrum)" : "",
1897 ((geo->bg[i].flags & IEEE80211_CH_NO_IBSS) ||
1898 (geo->bg[i].flags & IEEE80211_CH_RADAR_DETECT))
1899 ? "" : ", IBSS",
1900 geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1901 "passive only" : "active/passive",
1902 geo->bg[i].flags & IEEE80211_CH_B_ONLY ?
1903 "B" : "B/G");
1904 }
1905
1906 len += sprintf(&buf[len],
1907 "Displaying %d channels in 5.2Ghz band "
1908 "(802.11a):\n", geo->a_channels);
1909 for (i = 0; i < geo->a_channels; i++) {
1910 len += sprintf(&buf[len], "%d: BSS%s%s, %s.\n",
1911 geo->a[i].channel,
1912 geo->a[i].flags & IEEE80211_CH_RADAR_DETECT ?
1913 " (radar spectrum)" : "",
1914 ((geo->a[i].flags & IEEE80211_CH_NO_IBSS) ||
1915 (geo->a[i].flags & IEEE80211_CH_RADAR_DETECT))
1916 ? "" : ", IBSS",
1917 geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY ?
1918 "passive only" : "active/passive");
1919 }
1920
1921 return len;
1922}
1923
1924static DEVICE_ATTR(channels, S_IRUSR, show_channels, NULL);
1925
James Ketrenosea2b26e2005-08-24 21:25:16 -05001926static void notify_wx_assoc_event(struct ipw_priv *priv)
1927{
1928 union iwreq_data wrqu;
1929 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1930 if (priv->status & STATUS_ASSOCIATED)
1931 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1932 else
1933 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1934 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1935}
1936
James Ketrenos43f66a62005-03-25 12:31:53 -06001937static void ipw_irq_tasklet(struct ipw_priv *priv)
1938{
1939 u32 inta, inta_mask, handled = 0;
1940 unsigned long flags;
1941 int rc = 0;
1942
Zhu Yi89c318e2006-06-08 22:19:49 -07001943 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001944
James Ketrenosb095c382005-08-24 22:04:42 -05001945 inta = ipw_read32(priv, IPW_INTA_RW);
1946 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1947 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001948
1949 /* Add any cached INTA values that need to be handled */
1950 inta |= priv->isr_inta;
1951
Zhu Yi89c318e2006-06-08 22:19:49 -07001952 spin_unlock_irqrestore(&priv->irq_lock, flags);
1953
1954 spin_lock_irqsave(&priv->lock, flags);
1955
James Ketrenos43f66a62005-03-25 12:31:53 -06001956 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001957 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001958 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001959 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001960 }
1961
James Ketrenosb095c382005-08-24 22:04:42 -05001962 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001963 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001964 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001965 priv->status &= ~STATUS_HCMD_ACTIVE;
1966 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001967 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001968 }
1969
James Ketrenosb095c382005-08-24 22:04:42 -05001970 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001971 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001972 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001973 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001974 }
1975
James Ketrenosb095c382005-08-24 22:04:42 -05001976 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001977 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001978 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001979 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001980 }
1981
James Ketrenosb095c382005-08-24 22:04:42 -05001982 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001983 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001984 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001985 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001986 }
1987
James Ketrenosb095c382005-08-24 22:04:42 -05001988 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001989 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001990 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001991 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001992 }
1993
James Ketrenosb095c382005-08-24 22:04:42 -05001994 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001995 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001996 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001997 }
1998
James Ketrenosb095c382005-08-24 22:04:42 -05001999 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002000 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002001 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06002002 }
2003
James Ketrenosb095c382005-08-24 22:04:42 -05002004 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002005 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002006 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002007 }
2008
James Ketrenosb095c382005-08-24 22:04:42 -05002009 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002010 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002011 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002012 }
2013
James Ketrenosb095c382005-08-24 22:04:42 -05002014 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002015 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002016 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002017 }
2018
James Ketrenosb095c382005-08-24 22:04:42 -05002019 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002020 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
2021 priv->status |= STATUS_RF_KILL_HW;
2022 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05002023 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06002024 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -04002025 cancel_delayed_work(&priv->request_direct_scan);
2026 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -04002027 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -05002028 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06002029 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05002030 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06002031 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002032
James Ketrenosb095c382005-08-24 22:04:42 -05002033 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002034 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002035 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002036 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002037 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
2038 struct ipw_fw_error *error =
2039 ipw_alloc_error_log(priv);
2040 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07002041 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002042 }
James Ketrenosb39860c2005-08-12 09:36:32 -05002043 } else {
2044 priv->error = ipw_alloc_error_log(priv);
2045 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002046 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002047 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08002048 IPW_DEBUG_FW("Error allocating sysfs 'error' "
2049 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05002050 if (ipw_debug_level & IPW_DL_FW_ERRORS)
2051 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05002052 }
2053
James Ketrenosb095c382005-08-24 22:04:42 -05002054 /* XXX: If hardware encryption is for WPA/WPA2,
2055 * we have to notify the supplicant. */
2056 if (priv->ieee->sec.encrypt) {
2057 priv->status &= ~STATUS_ASSOCIATED;
2058 notify_wx_assoc_event(priv);
2059 }
2060
2061 /* Keep the restart process from trying to send host
2062 * commands by clearing the INIT status bit */
2063 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05002064
2065 /* Cancel currently queued command. */
2066 priv->status &= ~STATUS_HCMD_ACTIVE;
2067 wake_up_interruptible(&priv->wait_command_queue);
2068
James Ketrenos43f66a62005-03-25 12:31:53 -06002069 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05002070 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002071 }
2072
James Ketrenosb095c382005-08-24 22:04:42 -05002073 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002074 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002075 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06002076 }
2077
2078 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002079 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06002080 }
2081
Zhu Yi89c318e2006-06-08 22:19:49 -07002082 spin_unlock_irqrestore(&priv->lock, flags);
2083
James Ketrenos43f66a62005-03-25 12:31:53 -06002084 /* enable all interrupts */
2085 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002086}
Jeff Garzikbf794512005-07-31 13:07:26 -04002087
James Ketrenos43f66a62005-03-25 12:31:53 -06002088#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2089static char *get_cmd_string(u8 cmd)
2090{
2091 switch (cmd) {
2092 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002093 IPW_CMD(POWER_DOWN);
2094 IPW_CMD(SYSTEM_CONFIG);
2095 IPW_CMD(MULTICAST_ADDRESS);
2096 IPW_CMD(SSID);
2097 IPW_CMD(ADAPTER_ADDRESS);
2098 IPW_CMD(PORT_TYPE);
2099 IPW_CMD(RTS_THRESHOLD);
2100 IPW_CMD(FRAG_THRESHOLD);
2101 IPW_CMD(POWER_MODE);
2102 IPW_CMD(WEP_KEY);
2103 IPW_CMD(TGI_TX_KEY);
2104 IPW_CMD(SCAN_REQUEST);
2105 IPW_CMD(SCAN_REQUEST_EXT);
2106 IPW_CMD(ASSOCIATE);
2107 IPW_CMD(SUPPORTED_RATES);
2108 IPW_CMD(SCAN_ABORT);
2109 IPW_CMD(TX_FLUSH);
2110 IPW_CMD(QOS_PARAMETERS);
2111 IPW_CMD(DINO_CONFIG);
2112 IPW_CMD(RSN_CAPABILITIES);
2113 IPW_CMD(RX_KEY);
2114 IPW_CMD(CARD_DISABLE);
2115 IPW_CMD(SEED_NUMBER);
2116 IPW_CMD(TX_POWER);
2117 IPW_CMD(COUNTRY_INFO);
2118 IPW_CMD(AIRONET_INFO);
2119 IPW_CMD(AP_TX_POWER);
2120 IPW_CMD(CCKM_INFO);
2121 IPW_CMD(CCX_VER_INFO);
2122 IPW_CMD(SET_CALIBRATION);
2123 IPW_CMD(SENSITIVITY_CALIB);
2124 IPW_CMD(RETRY_LIMIT);
2125 IPW_CMD(IPW_PRE_POWER_DOWN);
2126 IPW_CMD(VAP_BEACON_TEMPLATE);
2127 IPW_CMD(VAP_DTIM_PERIOD);
2128 IPW_CMD(EXT_SUPPORTED_RATES);
2129 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2130 IPW_CMD(VAP_QUIET_INTERVALS);
2131 IPW_CMD(VAP_CHANNEL_SWITCH);
2132 IPW_CMD(VAP_MANDATORY_CHANNELS);
2133 IPW_CMD(VAP_CELL_PWR_LIMIT);
2134 IPW_CMD(VAP_CF_PARAM_SET);
2135 IPW_CMD(VAP_SET_BEACONING_STATE);
2136 IPW_CMD(MEASUREMENT);
2137 IPW_CMD(POWER_CAPABILITY);
2138 IPW_CMD(SUPPORTED_CHANNELS);
2139 IPW_CMD(TPC_REPORT);
2140 IPW_CMD(WME_INFO);
2141 IPW_CMD(PRODUCTION_COMMAND);
2142 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002143 return "UNKNOWN";
2144 }
2145}
James Ketrenos43f66a62005-03-25 12:31:53 -06002146
2147#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002148
2149static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002150{
2151 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002152 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002153
James Ketrenosa613bff2005-08-24 21:43:11 -05002154 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002155 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002156 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2157 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002158 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002159 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002160 }
2161
2162 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002163
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002164 if (priv->cmdlog) {
2165 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2166 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2167 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2168 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2169 cmd->len);
2170 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2171 }
2172
James Ketrenosb095c382005-08-24 22:04:42 -05002173 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2174 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2175 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002176
2177#ifndef DEBUG_CMD_WEP_KEY
2178 if (cmd->cmd == IPW_CMD_WEP_KEY)
2179 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2180 else
2181#endif
2182 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2183
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002184 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002185 if (rc) {
2186 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002187 IPW_ERROR("Failed to send %s: Reason %d\n",
2188 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002189 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002190 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002191 }
2192 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002193
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002194 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2195 !(priv->
2196 status & STATUS_HCMD_ACTIVE),
2197 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002198 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002199 spin_lock_irqsave(&priv->lock, flags);
2200 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002201 IPW_ERROR("Failed to send %s: Command timed out.\n",
2202 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002203 priv->status &= ~STATUS_HCMD_ACTIVE;
2204 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002205 rc = -EIO;
2206 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002207 }
2208 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002209 } else
2210 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002211
James Ketrenosb095c382005-08-24 22:04:42 -05002212 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002213 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2214 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002215 rc = -EIO;
2216 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002217 }
2218
Zhu Yi2638bc32006-01-24 16:37:52 +08002219 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002220 if (priv->cmdlog) {
2221 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2222 priv->cmdlog_pos %= priv->cmdlog_len;
2223 }
2224 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002225}
2226
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002227static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002228{
2229 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002230 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002231 };
2232
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002233 return __ipw_send_cmd(priv, &cmd);
2234}
2235
2236static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2237 void *data)
2238{
2239 struct host_cmd cmd = {
2240 .cmd = command,
2241 .len = len,
2242 .param = data,
2243 };
2244
2245 return __ipw_send_cmd(priv, &cmd);
2246}
2247
2248static int ipw_send_host_complete(struct ipw_priv *priv)
2249{
James Ketrenos43f66a62005-03-25 12:31:53 -06002250 if (!priv) {
2251 IPW_ERROR("Invalid args\n");
2252 return -1;
2253 }
2254
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002255 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002256}
2257
Zhu Yid685b8c2006-04-13 17:20:27 +08002258static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002259{
Zhu Yid685b8c2006-04-13 17:20:27 +08002260 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2261 sizeof(priv->sys_config),
2262 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002263}
2264
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002265static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002266{
James Ketrenos43f66a62005-03-25 12:31:53 -06002267 if (!priv || !ssid) {
2268 IPW_ERROR("Invalid args\n");
2269 return -1;
2270 }
2271
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002272 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002273 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002274}
2275
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002276static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002277{
James Ketrenos43f66a62005-03-25 12:31:53 -06002278 if (!priv || !mac) {
2279 IPW_ERROR("Invalid args\n");
2280 return -1;
2281 }
2282
Johannes Berge1749612008-10-27 15:59:26 -07002283 IPW_DEBUG_INFO("%s: Setting MAC to %pM\n",
2284 priv->net_dev->name, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002285
Zhu Yi2638bc32006-01-24 16:37:52 +08002286 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002287}
2288
James Ketrenosa613bff2005-08-24 21:43:11 -05002289/*
2290 * NOTE: This must be executed from our workqueue as it results in udelay
2291 * being called which may corrupt the keyboard if executed on default
2292 * workqueue
2293 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002294static void ipw_adapter_restart(void *adapter)
2295{
2296 struct ipw_priv *priv = adapter;
2297
2298 if (priv->status & STATUS_RF_KILL_MASK)
2299 return;
2300
2301 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002302
2303 if (priv->assoc_network &&
2304 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2305 ipw_remove_current_network(priv);
2306
James Ketrenos43f66a62005-03-25 12:31:53 -06002307 if (ipw_up(priv)) {
2308 IPW_ERROR("Failed to up device\n");
2309 return;
2310 }
2311}
2312
David Howellsc4028952006-11-22 14:57:56 +00002313static void ipw_bg_adapter_restart(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002314{
David Howellsc4028952006-11-22 14:57:56 +00002315 struct ipw_priv *priv =
2316 container_of(work, struct ipw_priv, adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08002317 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002318 ipw_adapter_restart(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002319 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002320}
2321
James Ketrenos43f66a62005-03-25 12:31:53 -06002322#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2323
2324static void ipw_scan_check(void *data)
2325{
2326 struct ipw_priv *priv = data;
2327 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2328 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002329 "adapter after (%dms).\n",
2330 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002331 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002332 }
2333}
2334
David Howellsc4028952006-11-22 14:57:56 +00002335static void ipw_bg_scan_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05002336{
David Howellsc4028952006-11-22 14:57:56 +00002337 struct ipw_priv *priv =
2338 container_of(work, struct ipw_priv, scan_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08002339 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00002340 ipw_scan_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08002341 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002342}
2343
James Ketrenos43f66a62005-03-25 12:31:53 -06002344static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2345 struct ipw_scan_request_ext *request)
2346{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002347 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002348 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002349}
2350
2351static int ipw_send_scan_abort(struct ipw_priv *priv)
2352{
James Ketrenos43f66a62005-03-25 12:31:53 -06002353 if (!priv) {
2354 IPW_ERROR("Invalid args\n");
2355 return -1;
2356 }
2357
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002358 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002359}
2360
2361static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2362{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002363 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002364 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002365 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002366
2367 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002368 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002369}
2370
2371static int ipw_send_associate(struct ipw_priv *priv,
2372 struct ipw_associate *associate)
2373{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002374 if (!priv || !associate) {
2375 IPW_ERROR("Invalid args\n");
2376 return -1;
2377 }
2378
Al Viro5b5e8072007-12-27 01:54:06 -05002379 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(*associate),
2380 associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002381}
2382
2383static int ipw_send_supported_rates(struct ipw_priv *priv,
2384 struct ipw_supported_rates *rates)
2385{
James Ketrenos43f66a62005-03-25 12:31:53 -06002386 if (!priv || !rates) {
2387 IPW_ERROR("Invalid args\n");
2388 return -1;
2389 }
2390
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002391 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002392 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002393}
2394
2395static int ipw_set_random_seed(struct ipw_priv *priv)
2396{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002397 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002398
2399 if (!priv) {
2400 IPW_ERROR("Invalid args\n");
2401 return -1;
2402 }
2403
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002404 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002405
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002406 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002407}
2408
James Ketrenos43f66a62005-03-25 12:31:53 -06002409static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2410{
Al Viroe62e1ee2007-12-27 01:36:46 -05002411 __le32 v = cpu_to_le32(phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002412 if (!priv) {
2413 IPW_ERROR("Invalid args\n");
2414 return -1;
2415 }
2416
Al Viroe62e1ee2007-12-27 01:36:46 -05002417 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(v), &v);
James Ketrenos43f66a62005-03-25 12:31:53 -06002418}
James Ketrenos43f66a62005-03-25 12:31:53 -06002419
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002420static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002421{
James Ketrenos43f66a62005-03-25 12:31:53 -06002422 if (!priv || !power) {
2423 IPW_ERROR("Invalid args\n");
2424 return -1;
2425 }
2426
Zhu Yi2638bc32006-01-24 16:37:52 +08002427 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002428}
James Ketrenos43f66a62005-03-25 12:31:53 -06002429
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002430static int ipw_set_tx_power(struct ipw_priv *priv)
2431{
Larry Finger1867b112006-02-28 09:48:28 -06002432 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002433 struct ipw_tx_power tx_power;
2434 s8 max_power;
2435 int i;
2436
2437 memset(&tx_power, 0, sizeof(tx_power));
2438
2439 /* configure device for 'G' band */
2440 tx_power.ieee_mode = IPW_G_MODE;
2441 tx_power.num_channels = geo->bg_channels;
2442 for (i = 0; i < geo->bg_channels; i++) {
2443 max_power = geo->bg[i].max_power;
2444 tx_power.channels_tx_power[i].channel_number =
2445 geo->bg[i].channel;
2446 tx_power.channels_tx_power[i].tx_power = max_power ?
2447 min(max_power, priv->tx_power) : priv->tx_power;
2448 }
2449 if (ipw_send_tx_power(priv, &tx_power))
2450 return -EIO;
2451
2452 /* configure device to also handle 'B' band */
2453 tx_power.ieee_mode = IPW_B_MODE;
2454 if (ipw_send_tx_power(priv, &tx_power))
2455 return -EIO;
2456
2457 /* configure device to also handle 'A' band */
2458 if (priv->ieee->abg_true) {
2459 tx_power.ieee_mode = IPW_A_MODE;
2460 tx_power.num_channels = geo->a_channels;
2461 for (i = 0; i < tx_power.num_channels; i++) {
2462 max_power = geo->a[i].max_power;
2463 tx_power.channels_tx_power[i].channel_number =
2464 geo->a[i].channel;
2465 tx_power.channels_tx_power[i].tx_power = max_power ?
2466 min(max_power, priv->tx_power) : priv->tx_power;
2467 }
2468 if (ipw_send_tx_power(priv, &tx_power))
2469 return -EIO;
2470 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002471 return 0;
2472}
2473
2474static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2475{
2476 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002477 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002478 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002479
2480 if (!priv) {
2481 IPW_ERROR("Invalid args\n");
2482 return -1;
2483 }
2484
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002485 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2486 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002487}
2488
2489static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2490{
2491 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002492 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002493 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002494
2495 if (!priv) {
2496 IPW_ERROR("Invalid args\n");
2497 return -1;
2498 }
2499
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002500 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2501 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002502}
2503
2504static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2505{
Al Viroe62e1ee2007-12-27 01:36:46 -05002506 __le32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002507
2508 if (!priv) {
2509 IPW_ERROR("Invalid args\n");
2510 return -1;
2511 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002512
James Ketrenos43f66a62005-03-25 12:31:53 -06002513 /* If on battery, set to 3, if AC set to CAM, else user
2514 * level */
2515 switch (mode) {
2516 case IPW_POWER_BATTERY:
Al Viroe62e1ee2007-12-27 01:36:46 -05002517 param = cpu_to_le32(IPW_POWER_INDEX_3);
James Ketrenos43f66a62005-03-25 12:31:53 -06002518 break;
2519 case IPW_POWER_AC:
Al Viroe62e1ee2007-12-27 01:36:46 -05002520 param = cpu_to_le32(IPW_POWER_MODE_CAM);
James Ketrenos43f66a62005-03-25 12:31:53 -06002521 break;
2522 default:
Al Viroe62e1ee2007-12-27 01:36:46 -05002523 param = cpu_to_le32(mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06002524 break;
2525 }
2526
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002527 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002528 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002529}
2530
James Ketrenosafbf30a2005-08-25 00:05:33 -05002531static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2532{
2533 struct ipw_retry_limit retry_limit = {
2534 .short_retry_limit = slimit,
2535 .long_retry_limit = llimit
2536 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002537
2538 if (!priv) {
2539 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002540 return -1;
2541 }
2542
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002543 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002544 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002545}
2546
2547/*
2548 * The IPW device contains a Microwire compatible EEPROM that stores
2549 * various data like the MAC address. Usually the firmware has exclusive
2550 * access to the eeprom, but during device initialization (before the
2551 * device driver has sent the HostComplete command to the firmware) the
2552 * device driver has read access to the EEPROM by way of indirect addressing
2553 * through a couple of memory mapped registers.
2554 *
2555 * The following is a simplified implementation for pulling data out of the
2556 * the eeprom, along with some helper functions to find information in
2557 * the per device private data's copy of the eeprom.
2558 *
2559 * NOTE: To better understand how these functions work (i.e what is a chip
2560 * select and why do have to keep driving the eeprom clock?), read
2561 * just about any data sheet for a Microwire compatible EEPROM.
2562 */
2563
2564/* write a 32 bit value into the indirect accessor register */
2565static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2566{
2567 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002568
James Ketrenos43f66a62005-03-25 12:31:53 -06002569 /* the eeprom requires some time to complete the operation */
2570 udelay(p->eeprom_delay);
2571
2572 return;
2573}
2574
2575/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002576static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002577{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002578 eeprom_write_reg(priv, 0);
2579 eeprom_write_reg(priv, EEPROM_BIT_CS);
2580 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2581 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002582}
2583
2584/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002585static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002586{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002587 eeprom_write_reg(priv, EEPROM_BIT_CS);
2588 eeprom_write_reg(priv, 0);
2589 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002590}
2591
2592/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002593static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002594{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002595 int d = (bit ? EEPROM_BIT_DI : 0);
2596 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2597 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002598}
2599
2600/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002601static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002602{
2603 int i;
2604
2605 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002606 eeprom_write_bit(priv, 1);
2607 eeprom_write_bit(priv, op & 2);
2608 eeprom_write_bit(priv, op & 1);
2609 for (i = 7; i >= 0; i--) {
2610 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002611 }
2612}
2613
2614/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002615static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002616{
2617 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002618 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002619
James Ketrenos43f66a62005-03-25 12:31:53 -06002620 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002621 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002622
2623 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002624 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002625
2626 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002627 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002628 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002629 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2630 eeprom_write_reg(priv, EEPROM_BIT_CS);
2631 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2632 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002633 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002634
James Ketrenos43f66a62005-03-25 12:31:53 -06002635 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002636 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002637 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002638
James Ketrenos43f66a62005-03-25 12:31:53 -06002639 return r;
2640}
2641
2642/* helper function for pulling the mac address out of the private */
2643/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002644static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002645{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002646 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002647}
2648
2649/*
2650 * Either the device driver (i.e. the host) or the firmware can
2651 * load eeprom data into the designated region in SRAM. If neither
2652 * happens then the FW will shutdown with a fatal error.
2653 *
2654 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2655 * bit needs region of shared SRAM needs to be non-zero.
2656 */
2657static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2658{
2659 int i;
Al Viroe62e1ee2007-12-27 01:36:46 -05002660 __le16 *eeprom = (__le16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002661
James Ketrenos43f66a62005-03-25 12:31:53 -06002662 IPW_DEBUG_TRACE(">>\n");
2663
2664 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002665 for (i = 0; i < 128; i++)
Al Viroe62e1ee2007-12-27 01:36:46 -05002666 eeprom[i] = cpu_to_le16(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002667
Jeff Garzikbf794512005-07-31 13:07:26 -04002668 /*
2669 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002670 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002671 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002672 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002673 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002674 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2675
2676 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002677 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002678 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002679
2680 /* Do not load eeprom data on fatal error or suspend */
2681 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2682 } else {
2683 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2684
2685 /* Load eeprom data on fatal error or suspend */
2686 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2687 }
2688
2689 IPW_DEBUG_TRACE("<<\n");
2690}
2691
Arjan van de Ven858119e2006-01-14 13:20:43 -08002692static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002693{
2694 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002695 if (!count)
2696 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002697 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002698 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002699 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002700}
2701
2702static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2703{
James Ketrenosb095c382005-08-24 22:04:42 -05002704 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002705 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002706 sizeof(struct command_block));
2707}
2708
2709static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002710{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002711
2712 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002713
James Ketrenos43f66a62005-03-25 12:31:53 -06002714 /* Start the dma */
2715 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002716
James Ketrenos43f66a62005-03-25 12:31:53 -06002717 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002718 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002719
2720 IPW_DEBUG_FW("<< : \n");
2721 return 0;
2722}
2723
2724static void ipw_fw_dma_abort(struct ipw_priv *priv)
2725{
2726 u32 control = 0;
2727
2728 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002729
Pavel Machek67fd6b42006-07-11 15:34:05 +02002730 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002731 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002732 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002733 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002734
James Ketrenos43f66a62005-03-25 12:31:53 -06002735 IPW_DEBUG_FW("<< \n");
2736}
2737
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002738static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2739 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002740{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002741 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002742 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002743 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002744 IPW_DEBUG_FW(">> :\n");
2745
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002746 ipw_write_indirect(priv, address, (u8 *) cb,
2747 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002748
2749 IPW_DEBUG_FW("<< :\n");
2750 return 0;
2751
2752}
2753
2754static int ipw_fw_dma_kick(struct ipw_priv *priv)
2755{
2756 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002757 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002758
2759 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002760
James Ketrenos43f66a62005-03-25 12:31:53 -06002761 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002762 ipw_fw_dma_write_command_block(priv, index,
2763 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002764
2765 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002766 ipw_clear_bit(priv, IPW_RESET_REG,
2767 IPW_RESET_REG_MASTER_DISABLED |
2768 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002769
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002770 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002771 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002772 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002773
2774 IPW_DEBUG_FW("<< :\n");
2775 return 0;
2776}
2777
2778static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2779{
2780 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002781 u32 register_value = 0;
2782 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002783
2784 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002785 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002786 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002787
2788 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002789 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2790 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002791
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002792 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002793 cb_fields_address = address;
2794 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002795 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002796
2797 cb_fields_address += sizeof(u32);
2798 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002799 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002800
2801 cb_fields_address += sizeof(u32);
2802 register_value = ipw_read_reg32(priv, cb_fields_address);
2803 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2804 register_value);
2805
2806 cb_fields_address += sizeof(u32);
2807 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002808 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002809
2810 IPW_DEBUG_FW(">> :\n");
2811}
2812
2813static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2814{
2815 u32 current_cb_address = 0;
2816 u32 current_cb_index = 0;
2817
2818 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002819 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002820
James Ketrenosb095c382005-08-24 22:04:42 -05002821 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002822 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002823
James Ketrenos43f66a62005-03-25 12:31:53 -06002824 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002825 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002826
2827 IPW_DEBUG_FW(">> :\n");
2828 return current_cb_index;
2829
2830}
2831
2832static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2833 u32 src_address,
2834 u32 dest_address,
2835 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002836 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002837{
2838
Jeff Garzikbf794512005-07-31 13:07:26 -04002839 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002840 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2841 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002842 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002843 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002844
2845 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2846 src_address, dest_address, length);
2847
2848 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2849 return -1;
2850
2851 last_cb_element = priv->sram_desc.last_cb_index;
2852 cb = &priv->sram_desc.cb_list[last_cb_element];
2853 priv->sram_desc.last_cb_index++;
2854
2855 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002856 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002857 control |= CB_INT_ENABLED;
2858
2859 if (is_last)
2860 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002861
James Ketrenos43f66a62005-03-25 12:31:53 -06002862 control |= length;
2863
2864 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002865 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002866
2867 /* Copy the Source and Destination addresses */
2868 cb->dest_addr = dest_address;
2869 cb->source_addr = src_address;
2870
2871 /* Copy the Control Word last */
2872 cb->control = control;
2873
2874 return 0;
2875}
2876
2877static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002878 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002879{
2880 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002881 u32 src_offset = 0;
2882 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002883 int status = 0;
2884 IPW_DEBUG_FW(">> \n");
2885 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2886 src_phys, dest_address, length);
2887 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002888 status = ipw_fw_dma_add_command_block(priv,
2889 src_phys + src_offset,
2890 dest_address +
2891 dest_offset,
2892 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002893 if (status) {
2894 IPW_DEBUG_FW_INFO(": Failed\n");
2895 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002896 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002897 IPW_DEBUG_FW_INFO(": Added new cb\n");
2898
2899 src_offset += CB_MAX_LENGTH;
2900 dest_offset += CB_MAX_LENGTH;
2901 bytes_left -= CB_MAX_LENGTH;
2902 }
2903
2904 /* add the buffer tail */
2905 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002906 status =
2907 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2908 dest_address + dest_offset,
2909 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002910 if (status) {
2911 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2912 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002913 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002914 IPW_DEBUG_FW_INFO
2915 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002916 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002917
James Ketrenos43f66a62005-03-25 12:31:53 -06002918 IPW_DEBUG_FW("<< \n");
2919 return 0;
2920}
2921
2922static int ipw_fw_dma_wait(struct ipw_priv *priv)
2923{
Zhu Yi397ae122006-01-24 16:37:22 +08002924 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002925 u32 watchdog = 0;
2926
2927 IPW_DEBUG_FW(">> : \n");
2928
2929 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002930 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002931 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002932
2933 while (current_index < priv->sram_desc.last_cb_index) {
2934 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002935 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002936 current_index = ipw_fw_dma_command_block_index(priv);
2937
Zhu Yi397ae122006-01-24 16:37:22 +08002938 if (previous_index < current_index) {
2939 watchdog = 0;
2940 continue;
2941 }
2942 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002943 IPW_DEBUG_FW_INFO("Timeout\n");
2944 ipw_fw_dma_dump_command_block(priv);
2945 ipw_fw_dma_abort(priv);
2946 return -1;
2947 }
2948 }
2949
2950 ipw_fw_dma_abort(priv);
2951
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002952 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002953 ipw_set_bit(priv, IPW_RESET_REG,
2954 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002955
2956 IPW_DEBUG_FW("<< dmaWaitSync \n");
2957 return 0;
2958}
2959
Jeff Garzikbf794512005-07-31 13:07:26 -04002960static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002961{
2962 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002963 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002964 unsigned long flags;
2965
2966 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002967 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2968 network = list_entry(element, struct ieee80211_network, list);
2969 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2970 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002971 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002972 &priv->ieee->network_free_list);
2973 }
2974 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002975 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002976}
2977
2978/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002979 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002980 * Reads debug register from domain0.
2981 * If card is present, pre-defined value should
2982 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002983 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002984 * @param priv
2985 * @return 1 if card is present, 0 otherwise
2986 */
2987static inline int ipw_alive(struct ipw_priv *priv)
2988{
2989 return ipw_read32(priv, 0x90) == 0xd55555d5;
2990}
2991
Zhu Yic7b6a672006-01-24 16:37:05 +08002992/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002993static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002994 int timeout)
2995{
2996 int i = 0;
2997
2998 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002999 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06003000 return i;
3001 mdelay(10);
3002 i += 10;
3003 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04003004
James Ketrenos43f66a62005-03-25 12:31:53 -06003005 return -ETIME;
3006}
3007
Jeff Garzikbf794512005-07-31 13:07:26 -04003008/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06003009 * the ipw hardware. It assumes the buffer has all the bits for the
3010 * image and the caller is handling the memory allocation and clean up.
3011 */
3012
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003013static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06003014{
3015 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003016
James Ketrenos43f66a62005-03-25 12:31:53 -06003017 IPW_DEBUG_TRACE(">> \n");
3018 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05003019 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003020
Zhu Yic7b6a672006-01-24 16:37:05 +08003021 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05003022 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3023 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06003024 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003025 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003026 return -1;
3027 }
3028
3029 IPW_DEBUG_INFO("stop master %dms\n", rc);
3030
3031 return rc;
3032}
3033
3034static void ipw_arc_release(struct ipw_priv *priv)
3035{
3036 IPW_DEBUG_TRACE(">> \n");
3037 mdelay(5);
3038
James Ketrenosb095c382005-08-24 22:04:42 -05003039 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003040
3041 /* no one knows timing, for safety add some delay */
3042 mdelay(5);
3043}
3044
James Ketrenos43f66a62005-03-25 12:31:53 -06003045struct fw_chunk {
Al Viroe62e1ee2007-12-27 01:36:46 -05003046 __le32 address;
3047 __le32 length;
James Ketrenos43f66a62005-03-25 12:31:53 -06003048};
3049
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003050static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003051{
3052 int rc = 0, i, addr;
3053 u8 cr = 0;
Al Viroe62e1ee2007-12-27 01:36:46 -05003054 __le16 *image;
James Ketrenos43f66a62005-03-25 12:31:53 -06003055
Al Viroe62e1ee2007-12-27 01:36:46 -05003056 image = (__le16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04003057
James Ketrenos43f66a62005-03-25 12:31:53 -06003058 IPW_DEBUG_TRACE(">> \n");
3059
3060 rc = ipw_stop_master(priv);
3061
3062 if (rc < 0)
3063 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003064
James Ketrenosb095c382005-08-24 22:04:42 -05003065 for (addr = IPW_SHARED_LOWER_BOUND;
3066 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003067 ipw_write32(priv, addr, 0);
3068 }
3069
3070 /* no ucode (yet) */
3071 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3072 /* destroy DMA queues */
3073 /* reset sequence */
3074
James Ketrenosb095c382005-08-24 22:04:42 -05003075 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003076 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003077 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003078 mdelay(1);
3079
3080 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003081 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003082 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003083
James Ketrenosb095c382005-08-24 22:04:42 -05003084 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003085 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003086
James Ketrenos43f66a62005-03-25 12:31:53 -06003087 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003088 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3089 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003090 mdelay(1);
3091
3092 /* write ucode */
3093 /**
3094 * @bug
3095 * Do NOT set indirect address register once and then
3096 * store data to indirect data register in the loop.
3097 * It seems very reasonable, but in this case DINO do not
3098 * accept ucode. It is essential to set address each time.
3099 */
3100 /* load new ipw uCode */
3101 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003102 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
Al Viroe62e1ee2007-12-27 01:36:46 -05003103 le16_to_cpu(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003104
James Ketrenos43f66a62005-03-25 12:31:53 -06003105 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003106 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3107 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003108
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003109 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003110
3111 /* wait for alive response */
3112 for (i = 0; i < 100; i++) {
3113 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003114 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003115 if (cr & DINO_RXFIFO_DATA)
3116 break;
3117 mdelay(1);
3118 }
3119
3120 if (cr & DINO_RXFIFO_DATA) {
3121 /* alive_command_responce size is NOT multiple of 4 */
Al Viroe62e1ee2007-12-27 01:36:46 -05003122 __le32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003123
3124 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003125 response_buffer[i] =
Al Viroe62e1ee2007-12-27 01:36:46 -05003126 cpu_to_le32(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003127 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003128 memcpy(&priv->dino_alive, response_buffer,
3129 sizeof(priv->dino_alive));
3130 if (priv->dino_alive.alive_command == 1
3131 && priv->dino_alive.ucode_valid == 1) {
3132 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003133 IPW_DEBUG_INFO
3134 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3135 "of %02d/%02d/%02d %02d:%02d\n",
3136 priv->dino_alive.software_revision,
3137 priv->dino_alive.software_revision,
3138 priv->dino_alive.device_identifier,
3139 priv->dino_alive.device_identifier,
3140 priv->dino_alive.time_stamp[0],
3141 priv->dino_alive.time_stamp[1],
3142 priv->dino_alive.time_stamp[2],
3143 priv->dino_alive.time_stamp[3],
3144 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003145 } else {
3146 IPW_DEBUG_INFO("Microcode is not alive\n");
3147 rc = -EINVAL;
3148 }
3149 } else {
3150 IPW_DEBUG_INFO("No alive response from DINO\n");
3151 rc = -ETIME;
3152 }
3153
3154 /* disable DINO, otherwise for some reason
3155 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003156 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003157
James Ketrenos43f66a62005-03-25 12:31:53 -06003158 return rc;
3159}
3160
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003161static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003162{
3163 int rc = -1;
3164 int offset = 0;
3165 struct fw_chunk *chunk;
3166 dma_addr_t shared_phys;
3167 u8 *shared_virt;
3168
3169 IPW_DEBUG_TRACE("<< : \n");
3170 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3171
3172 if (!shared_virt)
3173 return -ENOMEM;
3174
3175 memmove(shared_virt, data, len);
3176
3177 /* Start the Dma */
3178 rc = ipw_fw_dma_enable(priv);
3179
Alexander Beregalov0ee904c2009-04-11 14:50:23 +00003180 /* the DMA is already ready this would be a bug. */
3181 BUG_ON(priv->sram_desc.last_cb_index > 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003182
3183 do {
3184 chunk = (struct fw_chunk *)(data + offset);
3185 offset += sizeof(struct fw_chunk);
3186 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003187 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003188 * offeset*/
3189 /* Dma loading */
3190 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003191 le32_to_cpu(chunk->address),
3192 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003193 if (rc) {
3194 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3195 goto out;
3196 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003197
James Ketrenosa613bff2005-08-24 21:43:11 -05003198 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003199 } while (offset < len);
3200
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003201 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003202 rc = ipw_fw_dma_kick(priv);
3203 if (rc) {
3204 IPW_ERROR("dmaKick Failed\n");
3205 goto out;
3206 }
3207
3208 rc = ipw_fw_dma_wait(priv);
3209 if (rc) {
3210 IPW_ERROR("dmaWaitSync Failed\n");
3211 goto out;
3212 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003213 out:
3214 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003215 return rc;
3216}
3217
3218/* stop nic */
3219static int ipw_stop_nic(struct ipw_priv *priv)
3220{
3221 int rc = 0;
3222
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003223 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003224 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003225
James Ketrenosb095c382005-08-24 22:04:42 -05003226 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3227 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003228 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003229 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003230 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003231 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003232
James Ketrenosb095c382005-08-24 22:04:42 -05003233 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003234
James Ketrenos43f66a62005-03-25 12:31:53 -06003235 return rc;
3236}
3237
3238static void ipw_start_nic(struct ipw_priv *priv)
3239{
3240 IPW_DEBUG_TRACE(">>\n");
3241
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003242 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003243 ipw_clear_bit(priv, IPW_RESET_REG,
3244 IPW_RESET_REG_MASTER_DISABLED |
3245 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003246 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003247
James Ketrenos43f66a62005-03-25 12:31:53 -06003248 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003249 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3250 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003251
3252 IPW_DEBUG_TRACE("<<\n");
3253}
Jeff Garzikbf794512005-07-31 13:07:26 -04003254
James Ketrenos43f66a62005-03-25 12:31:53 -06003255static int ipw_init_nic(struct ipw_priv *priv)
3256{
3257 int rc;
3258
3259 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003260 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003261 /*prvHwInitNic */
3262 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003263 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003264
3265 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003266 ipw_write32(priv, IPW_READ_INT_REGISTER,
3267 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003268
3269 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003270 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3271 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003272 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003273 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3274
3275 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003276 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003277
3278 udelay(10);
3279
3280 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003281 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003282
3283 IPW_DEBUG_TRACE(">>\n");
3284 return 0;
3285}
3286
Jeff Garzikbf794512005-07-31 13:07:26 -04003287/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003288 * Probe is an ok place to call this from.
3289 */
3290static int ipw_reset_nic(struct ipw_priv *priv)
3291{
3292 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003293 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003294
3295 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003296
James Ketrenos43f66a62005-03-25 12:31:53 -06003297 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003298
James Ketrenosa613bff2005-08-24 21:43:11 -05003299 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003300 /* Clear the 'host command active' bit... */
3301 priv->status &= ~STATUS_HCMD_ACTIVE;
3302 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003303 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3304 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003305 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003306
3307 IPW_DEBUG_TRACE("<<\n");
3308 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003309}
James Ketrenos43f66a62005-03-25 12:31:53 -06003310
James Ketrenos9006ea72006-03-08 03:22:28 +08003311
3312struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003313 __le32 ver;
3314 __le32 boot_size;
3315 __le32 ucode_size;
3316 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003317 u8 data[0];
3318};
3319
Jeff Garzikbf794512005-07-31 13:07:26 -04003320static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003321 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003322{
James Ketrenos9006ea72006-03-08 03:22:28 +08003323 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003324 int rc;
3325
3326 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003327 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003328 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003329 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003330 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003331 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003332
James Ketrenos9006ea72006-03-08 03:22:28 +08003333 if ((*raw)->size < sizeof(*fw)) {
3334 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003335 return -EINVAL;
3336 }
3337
James Ketrenos9006ea72006-03-08 03:22:28 +08003338 fw = (void *)(*raw)->data;
3339
Zhu Yi0070f8c2006-04-13 17:20:12 +08003340 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3341 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003342 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3343 name, (*raw)->size);
3344 return -EINVAL;
3345 }
3346
3347 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003348 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003349 le32_to_cpu(fw->ver) >> 16,
3350 le32_to_cpu(fw->ver) & 0xff,
3351 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003352 return 0;
3353}
3354
James Ketrenosb095c382005-08-24 22:04:42 -05003355#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003356
Arjan van de Ven858119e2006-01-14 13:20:43 -08003357static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003358 struct ipw_rx_queue *rxq)
3359{
3360 unsigned long flags;
3361 int i;
3362
3363 spin_lock_irqsave(&rxq->lock, flags);
3364
3365 INIT_LIST_HEAD(&rxq->rx_free);
3366 INIT_LIST_HEAD(&rxq->rx_used);
3367
3368 /* Fill the rx_used queue with _all_ of the Rx buffers */
3369 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3370 /* In the reset function, these buffers may have been allocated
3371 * to an SKB, so we need to unmap and free potential storage */
3372 if (rxq->pool[i].skb != NULL) {
3373 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003374 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003375 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003376 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003377 }
3378 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3379 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003380
James Ketrenos43f66a62005-03-25 12:31:53 -06003381 /* Set us so that we have processed and used all buffers, but have
3382 * not restocked the Rx queue with fresh buffers */
3383 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003384 rxq->free_count = 0;
3385 spin_unlock_irqrestore(&rxq->lock, flags);
3386}
3387
3388#ifdef CONFIG_PM
3389static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003390static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003391
3392static void free_firmware(void)
3393{
3394 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003395 release_firmware(raw);
3396 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003397 fw_loaded = 0;
3398 }
3399}
3400#else
3401#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003402#endif
3403
3404static int ipw_load(struct ipw_priv *priv)
3405{
3406#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003407 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003408#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003409 struct ipw_fw *fw;
3410 u8 *boot_img, *ucode_img, *fw_img;
3411 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003412 int rc = 0, retries = 3;
3413
Zhu Yi397ae122006-01-24 16:37:22 +08003414 switch (priv->ieee->iw_mode) {
3415 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003416 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003417 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003418#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003419 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003420 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003421 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003422#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003423 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003424 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003425 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003426 }
Zhu Yi397ae122006-01-24 16:37:22 +08003427
James Ketrenos9006ea72006-03-08 03:22:28 +08003428 if (!name) {
3429 rc = -EINVAL;
3430 goto error;
3431 }
3432
3433#ifdef CONFIG_PM
3434 if (!fw_loaded) {
3435#endif
3436 rc = ipw_get_fw(priv, &raw, name);
3437 if (rc < 0)
3438 goto error;
3439#ifdef CONFIG_PM
3440 }
3441#endif
3442
3443 fw = (void *)raw->data;
3444 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003445 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3446 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3447 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003448
Zhu Yi397ae122006-01-24 16:37:22 +08003449 if (rc < 0)
3450 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003451
3452 if (!priv->rxq)
3453 priv->rxq = ipw_rx_queue_alloc(priv);
3454 else
3455 ipw_rx_queue_reset(priv, priv->rxq);
3456 if (!priv->rxq) {
3457 IPW_ERROR("Unable to initialize Rx queue\n");
3458 goto error;
3459 }
3460
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003461 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003462 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003463 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003464 priv->status &= ~STATUS_INT_ENABLED;
3465
3466 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003467 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003468
James Ketrenos43f66a62005-03-25 12:31:53 -06003469 ipw_stop_nic(priv);
3470
3471 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003472 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003473 IPW_ERROR("Unable to reset NIC\n");
3474 goto error;
3475 }
3476
James Ketrenosb095c382005-08-24 22:04:42 -05003477 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3478 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003479
3480 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003481 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003482 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003483 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003484 goto error;
3485 }
3486
3487 /* kick start the device */
3488 ipw_start_nic(priv);
3489
Zhu Yic7b6a672006-01-24 16:37:05 +08003490 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003491 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3492 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003493 if (rc < 0) {
3494 IPW_ERROR("device failed to boot initial fw image\n");
3495 goto error;
3496 }
3497 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3498
Jeff Garzikbf794512005-07-31 13:07:26 -04003499 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003500 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003501
3502 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003503 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003504 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003505 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003506 goto error;
3507 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003508
James Ketrenos43f66a62005-03-25 12:31:53 -06003509 /* stop nic */
3510 ipw_stop_nic(priv);
3511
3512 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003513 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003514 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003515 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003516 goto error;
3517 }
Zhu Yi397ae122006-01-24 16:37:22 +08003518#ifdef CONFIG_PM
3519 fw_loaded = 1;
3520#endif
3521
James Ketrenos43f66a62005-03-25 12:31:53 -06003522 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3523
3524 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003525 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003526 IPW_ERROR("Unable to initialize queues\n");
3527 goto error;
3528 }
3529
3530 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003531 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003532 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003533 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003534
James Ketrenos43f66a62005-03-25 12:31:53 -06003535 /* kick start the device */
3536 ipw_start_nic(priv);
3537
James Ketrenosb095c382005-08-24 22:04:42 -05003538 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003539 if (retries > 0) {
3540 IPW_WARNING("Parity error. Retrying init.\n");
3541 retries--;
3542 goto retry;
3543 }
3544
3545 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3546 rc = -EIO;
3547 goto error;
3548 }
3549
3550 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003551 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3552 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003553 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003554 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003555 goto error;
3556 }
3557 IPW_DEBUG_INFO("device response after %dms\n", rc);
3558
3559 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003560 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003561
3562 /* read eeprom data and initialize the eeprom region of sram */
3563 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003564 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003565
3566 /* enable interrupts */
3567 ipw_enable_interrupts(priv);
3568
3569 /* Ensure our queue has valid packets */
3570 ipw_rx_queue_replenish(priv);
3571
James Ketrenosb095c382005-08-24 22:04:42 -05003572 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003573
3574 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003575 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003576
3577#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003578 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003579#endif
3580 return 0;
3581
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003582 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003583 if (priv->rxq) {
3584 ipw_rx_queue_free(priv, priv->rxq);
3585 priv->rxq = NULL;
3586 }
3587 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003588 if (raw)
3589 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003590#ifdef CONFIG_PM
3591 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003592 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003593#endif
3594
3595 return rc;
3596}
3597
Jeff Garzikbf794512005-07-31 13:07:26 -04003598/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003599 * DMA services
3600 *
3601 * Theory of operation
3602 *
3603 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3604 * 2 empty entries always kept in the buffer to protect from overflow.
3605 *
3606 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003607 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3608 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003609 * Tx queue resumed.
3610 *
3611 * The IPW operates with six queues, one receive queue in the device's
3612 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003613 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003614 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003615 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003616 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003617 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003618 * we only utilize the first data transmit queue (queue1).
3619 */
3620
3621/**
3622 * Driver allocates buffers of this size for Rx
3623 */
3624
Dan Williams943dbef2008-02-14 17:49:41 -05003625/**
3626 * ipw_rx_queue_space - Return number of free slots available in queue.
3627 */
3628static int ipw_rx_queue_space(const struct ipw_rx_queue *q)
3629{
3630 int s = q->read - q->write;
3631 if (s <= 0)
3632 s += RX_QUEUE_SIZE;
3633 /* keep some buffer to not confuse full and empty queue */
3634 s -= 2;
3635 if (s < 0)
3636 s = 0;
3637 return s;
3638}
3639
3640static inline int ipw_tx_queue_space(const struct clx2_queue *q)
James Ketrenos43f66a62005-03-25 12:31:53 -06003641{
3642 int s = q->last_used - q->first_empty;
3643 if (s <= 0)
3644 s += q->n_bd;
3645 s -= 2; /* keep some reserve to not confuse empty and full situations */
3646 if (s < 0)
3647 s = 0;
3648 return s;
3649}
3650
3651static inline int ipw_queue_inc_wrap(int index, int n_bd)
3652{
3653 return (++index == n_bd) ? 0 : index;
3654}
3655
3656/**
3657 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003658 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003659 * @param q queue to init
3660 * @param count Number of BD's to allocate. Should be power of 2
3661 * @param read_register Address for 'read' register
3662 * (not offset within BAR, full address)
3663 * @param write_register Address for 'write' register
3664 * (not offset within BAR, full address)
3665 * @param base_register Address for 'base' register
3666 * (not offset within BAR, full address)
3667 * @param size Address for 'size' register
3668 * (not offset within BAR, full address)
3669 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003670static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003671 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003672{
3673 q->n_bd = count;
3674
3675 q->low_mark = q->n_bd / 4;
3676 if (q->low_mark < 4)
3677 q->low_mark = 4;
3678
3679 q->high_mark = q->n_bd / 8;
3680 if (q->high_mark < 2)
3681 q->high_mark = 2;
3682
3683 q->first_empty = q->last_used = 0;
3684 q->reg_r = read;
3685 q->reg_w = write;
3686
3687 ipw_write32(priv, base, q->dma_addr);
3688 ipw_write32(priv, size, count);
3689 ipw_write32(priv, read, 0);
3690 ipw_write32(priv, write, 0);
3691
3692 _ipw_read32(priv, 0x90);
3693}
3694
Jeff Garzikbf794512005-07-31 13:07:26 -04003695static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003696 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003697 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003698{
3699 struct pci_dev *dev = priv->pci_dev;
3700
3701 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3702 if (!q->txb) {
3703 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3704 return -ENOMEM;
3705 }
3706
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003707 q->bd =
3708 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003709 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003710 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003711 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003712 kfree(q->txb);
3713 q->txb = NULL;
3714 return -ENOMEM;
3715 }
3716
3717 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3718 return 0;
3719}
3720
3721/**
3722 * Free one TFD, those at index [txq->q.last_used].
3723 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003724 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003725 * @param dev
3726 * @param txq
3727 */
3728static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3729 struct clx2_tx_queue *txq)
3730{
3731 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3732 struct pci_dev *dev = priv->pci_dev;
3733 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003734
James Ketrenos43f66a62005-03-25 12:31:53 -06003735 /* classify bd */
3736 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3737 /* nothing to cleanup after for host commands */
3738 return;
3739
3740 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003741 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3742 IPW_ERROR("Too many chunks: %i\n",
3743 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003744 /** @todo issue fatal error, it is quite serious situation */
3745 return;
3746 }
3747
3748 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003749 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3750 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3751 le16_to_cpu(bd->u.data.chunk_len[i]),
3752 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003753 if (txq->txb[txq->q.last_used]) {
3754 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3755 txq->txb[txq->q.last_used] = NULL;
3756 }
3757 }
3758}
3759
3760/**
3761 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003762 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003763 * Empty queue by removing and destroying all BD's.
3764 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003765 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003766 * @param dev
3767 * @param q
3768 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003769static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003770{
3771 struct clx2_queue *q = &txq->q;
3772 struct pci_dev *dev = priv->pci_dev;
3773
Jeff Garzikbf794512005-07-31 13:07:26 -04003774 if (q->n_bd == 0)
3775 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003776
3777 /* first, empty all BD's */
3778 for (; q->first_empty != q->last_used;
3779 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3780 ipw_queue_tx_free_tfd(priv, txq);
3781 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003782
James Ketrenos43f66a62005-03-25 12:31:53 -06003783 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003784 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003785 q->dma_addr);
3786 kfree(txq->txb);
3787
3788 /* 0 fill whole structure */
3789 memset(txq, 0, sizeof(*txq));
3790}
3791
James Ketrenos43f66a62005-03-25 12:31:53 -06003792/**
3793 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003794 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003795 * @param priv
3796 */
3797static void ipw_tx_queue_free(struct ipw_priv *priv)
3798{
3799 /* Tx CMD queue */
3800 ipw_queue_tx_free(priv, &priv->txq_cmd);
3801
3802 /* Tx queues */
3803 ipw_queue_tx_free(priv, &priv->txq[0]);
3804 ipw_queue_tx_free(priv, &priv->txq[1]);
3805 ipw_queue_tx_free(priv, &priv->txq[2]);
3806 ipw_queue_tx_free(priv, &priv->txq[3]);
3807}
3808
Arjan van de Ven858119e2006-01-14 13:20:43 -08003809static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003810{
3811 /* First 3 bytes are manufacturer */
3812 bssid[0] = priv->mac_addr[0];
3813 bssid[1] = priv->mac_addr[1];
3814 bssid[2] = priv->mac_addr[2];
3815
3816 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003817 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003818
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003819 bssid[0] &= 0xfe; /* clear multicast bit */
3820 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003821}
3822
Arjan van de Ven858119e2006-01-14 13:20:43 -08003823static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003824{
3825 struct ipw_station_entry entry;
3826 int i;
3827
3828 for (i = 0; i < priv->num_stations; i++) {
3829 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3830 /* Another node is active in network */
3831 priv->missed_adhoc_beacons = 0;
3832 if (!(priv->config & CFG_STATIC_CHANNEL))
3833 /* when other nodes drop out, we drop out */
3834 priv->config &= ~CFG_ADHOC_PERSIST;
3835
3836 return i;
3837 }
3838 }
3839
3840 if (i == MAX_STATIONS)
3841 return IPW_INVALID_STATION;
3842
Johannes Berge1749612008-10-27 15:59:26 -07003843 IPW_DEBUG_SCAN("Adding AdHoc station: %pM\n", bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06003844
3845 entry.reserved = 0;
3846 entry.support_mode = 0;
3847 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3848 memcpy(priv->stations[i], bssid, ETH_ALEN);
3849 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003850 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003851 priv->num_stations++;
3852
3853 return i;
3854}
3855
Arjan van de Ven858119e2006-01-14 13:20:43 -08003856static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003857{
3858 int i;
3859
Jeff Garzikbf794512005-07-31 13:07:26 -04003860 for (i = 0; i < priv->num_stations; i++)
3861 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003862 return i;
3863
3864 return IPW_INVALID_STATION;
3865}
3866
3867static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3868{
3869 int err;
3870
Hong Liu7b996592005-08-25 17:36:13 +08003871 if (priv->status & STATUS_ASSOCIATING) {
3872 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3873 queue_work(priv->workqueue, &priv->disassociate);
3874 return;
3875 }
3876
3877 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003878 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3879 return;
3880 }
3881
Johannes Berge1749612008-10-27 15:59:26 -07003882 IPW_DEBUG_ASSOC("Disassocation attempt from %pM "
James Ketrenos43f66a62005-03-25 12:31:53 -06003883 "on channel %d.\n",
Johannes Berge1749612008-10-27 15:59:26 -07003884 priv->assoc_request.bssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06003885 priv->assoc_request.channel);
3886
3887 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3888 priv->status |= STATUS_DISASSOCIATING;
3889
3890 if (quiet)
3891 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3892 else
3893 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003894
James Ketrenos43f66a62005-03-25 12:31:53 -06003895 err = ipw_send_associate(priv, &priv->assoc_request);
3896 if (err) {
3897 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3898 "failed.\n");
3899 return;
3900 }
3901
3902}
3903
James Ketrenosc848d0a2005-08-24 21:56:24 -05003904static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003905{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003906 struct ipw_priv *priv = data;
3907 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3908 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003909 ipw_send_disassociate(data, 0);
Zhu Yib8ddafd2008-11-27 13:42:20 +08003910 netif_carrier_off(priv->net_dev);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003911 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003912}
3913
David Howellsc4028952006-11-22 14:57:56 +00003914static void ipw_bg_disassociate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06003915{
David Howellsc4028952006-11-22 14:57:56 +00003916 struct ipw_priv *priv =
3917 container_of(work, struct ipw_priv, disassociate);
Zhu Yi46441512006-01-24 16:37:59 +08003918 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00003919 ipw_disassociate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08003920 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003921}
3922
David Howellsc4028952006-11-22 14:57:56 +00003923static void ipw_system_config(struct work_struct *work)
Zhu Yid8bad6d2005-07-13 12:25:38 -05003924{
David Howellsc4028952006-11-22 14:57:56 +00003925 struct ipw_priv *priv =
3926 container_of(work, struct ipw_priv, system_config);
Zhu Yid685b8c2006-04-13 17:20:27 +08003927
3928#ifdef CONFIG_IPW2200_PROMISCUOUS
3929 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3930 priv->sys_config.accept_all_data_frames = 1;
3931 priv->sys_config.accept_non_directed_frames = 1;
3932 priv->sys_config.accept_all_mgmt_bcpr = 1;
3933 priv->sys_config.accept_all_mgmt_frames = 1;
3934 }
3935#endif
3936
3937 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003938}
3939
3940struct ipw_status_code {
3941 u16 status;
3942 const char *reason;
3943};
3944
3945static const struct ipw_status_code ipw_status_codes[] = {
3946 {0x00, "Successful"},
3947 {0x01, "Unspecified failure"},
3948 {0x0A, "Cannot support all requested capabilities in the "
3949 "Capability information field"},
3950 {0x0B, "Reassociation denied due to inability to confirm that "
3951 "association exists"},
3952 {0x0C, "Association denied due to reason outside the scope of this "
3953 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003954 {0x0D,
3955 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003956 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003957 {0x0E,
3958 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003959 "transaction sequence number out of expected sequence"},
3960 {0x0F, "Authentication rejected because of challenge failure"},
3961 {0x10, "Authentication rejected due to timeout waiting for next "
3962 "frame in sequence"},
3963 {0x11, "Association denied because AP is unable to handle additional "
3964 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003965 {0x12,
3966 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003967 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003968 {0x13,
3969 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003970 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003971 {0x14,
3972 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003973 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003974 {0x15,
3975 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003976 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003977 {0x19,
3978 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003979 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003980 {0x1A,
3981 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003982 "DSSS-OFDM operation"},
3983 {0x28, "Invalid Information Element"},
3984 {0x29, "Group Cipher is not valid"},
3985 {0x2A, "Pairwise Cipher is not valid"},
3986 {0x2B, "AKMP is not valid"},
3987 {0x2C, "Unsupported RSN IE version"},
3988 {0x2D, "Invalid RSN IE Capabilities"},
3989 {0x2E, "Cipher suite is rejected per security policy"},
3990};
3991
Jeff Garzikbf794512005-07-31 13:07:26 -04003992static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003993{
3994 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003995 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003996 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003997 return ipw_status_codes[i].reason;
3998 return "Unknown status value.";
3999}
James Ketrenos43f66a62005-03-25 12:31:53 -06004000
4001static void inline average_init(struct average *avg)
4002{
4003 memset(avg, 0, sizeof(*avg));
4004}
4005
Zhu Yi00d21de2006-04-13 17:19:02 +08004006#define DEPTH_RSSI 8
4007#define DEPTH_NOISE 16
4008static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
4009{
4010 return ((depth-1)*prev_avg + val)/depth;
4011}
4012
Arjan van de Ven858119e2006-01-14 13:20:43 -08004013static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06004014{
4015 avg->sum -= avg->entries[avg->pos];
4016 avg->sum += val;
4017 avg->entries[avg->pos++] = val;
4018 if (unlikely(avg->pos == AVG_ENTRIES)) {
4019 avg->init = 1;
4020 avg->pos = 0;
4021 }
4022}
4023
Arjan van de Ven858119e2006-01-14 13:20:43 -08004024static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06004025{
4026 if (!unlikely(avg->init)) {
4027 if (avg->pos)
4028 return avg->sum / avg->pos;
4029 return 0;
4030 }
4031
4032 return avg->sum / AVG_ENTRIES;
4033}
4034
4035static void ipw_reset_stats(struct ipw_priv *priv)
4036{
4037 u32 len = sizeof(u32);
4038
4039 priv->quality = 0;
4040
4041 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08004042 priv->exp_avg_rssi = -60;
4043 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06004044
4045 priv->last_rate = 0;
4046 priv->last_missed_beacons = 0;
4047 priv->last_rx_packets = 0;
4048 priv->last_tx_packets = 0;
4049 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04004050
James Ketrenos43f66a62005-03-25 12:31:53 -06004051 /* Firmware managed, reset only when NIC is restarted, so we have to
4052 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04004053 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06004054 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04004055 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06004056 &priv->last_tx_failures, &len);
4057
4058 /* Driver managed, reset with each association */
4059 priv->missed_adhoc_beacons = 0;
4060 priv->missed_beacons = 0;
4061 priv->tx_packets = 0;
4062 priv->rx_packets = 0;
4063
4064}
4065
Arjan van de Ven858119e2006-01-14 13:20:43 -08004066static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06004067{
4068 u32 i = 0x80000000;
4069 u32 mask = priv->rates_mask;
4070 /* If currently associated in B mode, restrict the maximum
4071 * rate match to B rates */
4072 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
4073 mask &= IEEE80211_CCK_RATES_MASK;
4074
4075 /* TODO: Verify that the rate is supported by the current rates
4076 * list. */
4077
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004078 while (i && !(mask & i))
4079 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06004080 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004081 case IEEE80211_CCK_RATE_1MB_MASK:
4082 return 1000000;
4083 case IEEE80211_CCK_RATE_2MB_MASK:
4084 return 2000000;
4085 case IEEE80211_CCK_RATE_5MB_MASK:
4086 return 5500000;
4087 case IEEE80211_OFDM_RATE_6MB_MASK:
4088 return 6000000;
4089 case IEEE80211_OFDM_RATE_9MB_MASK:
4090 return 9000000;
4091 case IEEE80211_CCK_RATE_11MB_MASK:
4092 return 11000000;
4093 case IEEE80211_OFDM_RATE_12MB_MASK:
4094 return 12000000;
4095 case IEEE80211_OFDM_RATE_18MB_MASK:
4096 return 18000000;
4097 case IEEE80211_OFDM_RATE_24MB_MASK:
4098 return 24000000;
4099 case IEEE80211_OFDM_RATE_36MB_MASK:
4100 return 36000000;
4101 case IEEE80211_OFDM_RATE_48MB_MASK:
4102 return 48000000;
4103 case IEEE80211_OFDM_RATE_54MB_MASK:
4104 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004105 }
4106
Jeff Garzikbf794512005-07-31 13:07:26 -04004107 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004108 return 11000000;
4109 else
4110 return 54000000;
4111}
4112
4113static u32 ipw_get_current_rate(struct ipw_priv *priv)
4114{
4115 u32 rate, len = sizeof(rate);
4116 int err;
4117
Jeff Garzikbf794512005-07-31 13:07:26 -04004118 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004119 return 0;
4120
4121 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004122 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004123 &len);
4124 if (err) {
4125 IPW_DEBUG_INFO("failed querying ordinals.\n");
4126 return 0;
4127 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004128 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004129 return ipw_get_max_rate(priv);
4130
4131 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004132 case IPW_TX_RATE_1MB:
4133 return 1000000;
4134 case IPW_TX_RATE_2MB:
4135 return 2000000;
4136 case IPW_TX_RATE_5MB:
4137 return 5500000;
4138 case IPW_TX_RATE_6MB:
4139 return 6000000;
4140 case IPW_TX_RATE_9MB:
4141 return 9000000;
4142 case IPW_TX_RATE_11MB:
4143 return 11000000;
4144 case IPW_TX_RATE_12MB:
4145 return 12000000;
4146 case IPW_TX_RATE_18MB:
4147 return 18000000;
4148 case IPW_TX_RATE_24MB:
4149 return 24000000;
4150 case IPW_TX_RATE_36MB:
4151 return 36000000;
4152 case IPW_TX_RATE_48MB:
4153 return 48000000;
4154 case IPW_TX_RATE_54MB:
4155 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004156 }
4157
4158 return 0;
4159}
4160
James Ketrenos43f66a62005-03-25 12:31:53 -06004161#define IPW_STATS_INTERVAL (2 * HZ)
4162static void ipw_gather_stats(struct ipw_priv *priv)
4163{
4164 u32 rx_err, rx_err_delta, rx_packets_delta;
4165 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4166 u32 missed_beacons_percent, missed_beacons_delta;
4167 u32 quality = 0;
4168 u32 len = sizeof(u32);
4169 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004170 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004171 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004172 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004173
4174 if (!(priv->status & STATUS_ASSOCIATED)) {
4175 priv->quality = 0;
4176 return;
4177 }
4178
4179 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004180 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004181 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004182 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004183 priv->last_missed_beacons = priv->missed_beacons;
4184 if (priv->assoc_request.beacon_interval) {
4185 missed_beacons_percent = missed_beacons_delta *
Al Viro5b5e8072007-12-27 01:54:06 -05004186 (HZ * le16_to_cpu(priv->assoc_request.beacon_interval)) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004187 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004188 } else {
4189 missed_beacons_percent = 0;
4190 }
4191 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4192
4193 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4194 rx_err_delta = rx_err - priv->last_rx_err;
4195 priv->last_rx_err = rx_err;
4196
4197 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4198 tx_failures_delta = tx_failures - priv->last_tx_failures;
4199 priv->last_tx_failures = tx_failures;
4200
4201 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4202 priv->last_rx_packets = priv->rx_packets;
4203
4204 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4205 priv->last_tx_packets = priv->tx_packets;
4206
4207 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004208 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004209 * Missed beacon: 100% = 0, 0% = 70% missed
4210 * Rate: 60% = 1Mbs, 100% = Max
4211 * Rx and Tx errors represent a straight % of total Rx/Tx
4212 * RSSI: 100% = > -50, 0% = < -80
4213 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004214 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004215 * The lowest computed quality is used.
4216 *
4217 */
4218#define BEACON_THRESHOLD 5
4219 beacon_quality = 100 - missed_beacons_percent;
4220 if (beacon_quality < BEACON_THRESHOLD)
4221 beacon_quality = 0;
4222 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004223 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004224 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004225 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004226 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004227
James Ketrenos43f66a62005-03-25 12:31:53 -06004228 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004229 max_rate = ipw_get_max_rate(priv);
4230 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004231 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4232 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004233
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004234 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004235 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004236 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004237 else
4238 rx_quality = 100;
4239 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4240 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004241
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004242 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004243 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004244 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004245 else
4246 tx_quality = 100;
4247 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4248 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004249
Zhu Yi00d21de2006-04-13 17:19:02 +08004250 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004251 signal_quality =
4252 (100 *
4253 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4254 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4255 (priv->ieee->perfect_rssi - rssi) *
4256 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4257 62 * (priv->ieee->perfect_rssi - rssi))) /
4258 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4259 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4260 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004261 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004262 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004263 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004264
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004265 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004266 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004267
Reinette Chatre21f8a732009-08-18 10:25:05 -07004268 quality = min(rx_quality, signal_quality);
4269 quality = min(tx_quality, quality);
4270 quality = min(rate_quality, quality);
4271 quality = min(beacon_quality, quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004272 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004273 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4274 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004275 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004276 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4277 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004278 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004279 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4280 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004281 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004282 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4283 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004284 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004285 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4286 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004287
4288 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004289
4290 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004291 IPW_STATS_INTERVAL);
4292}
4293
David Howellsc4028952006-11-22 14:57:56 +00004294static void ipw_bg_gather_stats(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05004295{
David Howellsc4028952006-11-22 14:57:56 +00004296 struct ipw_priv *priv =
4297 container_of(work, struct ipw_priv, gather_stats.work);
Zhu Yi46441512006-01-24 16:37:59 +08004298 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00004299 ipw_gather_stats(priv);
Zhu Yi46441512006-01-24 16:37:59 +08004300 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004301}
4302
Ben Cahille7582562005-10-06 15:34:41 -05004303/* Missed beacon behavior:
4304 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4305 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4306 * Above disassociate threshold, give up and stop scanning.
4307 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004308static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004309 int missed_count)
4310{
4311 priv->notif_missed_beacons = missed_count;
4312
James Ketrenosafbf30a2005-08-25 00:05:33 -05004313 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004314 priv->status & STATUS_ASSOCIATED) {
4315 /* If associated and we've hit the missed
4316 * beacon threshold, disassociate, turn
4317 * off roaming, and abort any active scans */
4318 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004319 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004320 "Missed beacon: %d - disassociate\n", missed_count);
4321 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004322 if (priv->status & STATUS_SCANNING) {
4323 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4324 IPW_DL_STATE,
4325 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004326 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004327 }
4328
James Ketrenosea2b26e2005-08-24 21:25:16 -05004329 queue_work(priv->workqueue, &priv->disassociate);
4330 return;
4331 }
4332
4333 if (priv->status & STATUS_ROAMING) {
4334 /* If we are currently roaming, then just
4335 * print a debug statement... */
4336 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4337 "Missed beacon: %d - roam in progress\n",
4338 missed_count);
4339 return;
4340 }
4341
Zhu Yi4bfdb912006-01-24 16:37:16 +08004342 if (roaming &&
4343 (missed_count > priv->roaming_threshold &&
4344 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004345 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004346 * bit in the status and kick off a scan.
4347 * This can happen several times before we reach
4348 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004349 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4350 "Missed beacon: %d - initiate "
4351 "roaming\n", missed_count);
4352 if (!(priv->status & STATUS_ROAMING)) {
4353 priv->status |= STATUS_ROAMING;
4354 if (!(priv->status & STATUS_SCANNING))
David Howellsc4028952006-11-22 14:57:56 +00004355 queue_delayed_work(priv->workqueue,
4356 &priv->request_scan, 0);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004357 }
4358 return;
4359 }
4360
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01004361 if (priv->status & STATUS_SCANNING &&
4362 missed_count > IPW_MB_SCAN_CANCEL_THRESHOLD) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004363 /* Stop scan to keep fw from getting
4364 * stuck (only if we aren't roaming --
4365 * otherwise we'll never scan more than 2 or 3
4366 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004367 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4368 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004369 queue_work(priv->workqueue, &priv->abort_scan);
4370 }
4371
4372 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004373}
4374
Dan Williams0b531672007-10-09 13:55:24 -04004375static void ipw_scan_event(struct work_struct *work)
4376{
4377 union iwreq_data wrqu;
4378
4379 struct ipw_priv *priv =
4380 container_of(work, struct ipw_priv, scan_event.work);
4381
4382 wrqu.data.length = 0;
4383 wrqu.data.flags = 0;
4384 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4385}
4386
4387static void handle_scan_event(struct ipw_priv *priv)
4388{
4389 /* Only userspace-requested scan completion events go out immediately */
4390 if (!priv->user_requested_scan) {
4391 if (!delayed_work_pending(&priv->scan_event))
4392 queue_delayed_work(priv->workqueue, &priv->scan_event,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004393 round_jiffies_relative(msecs_to_jiffies(4000)));
Dan Williams0b531672007-10-09 13:55:24 -04004394 } else {
4395 union iwreq_data wrqu;
4396
4397 priv->user_requested_scan = 0;
4398 cancel_delayed_work(&priv->scan_event);
4399
4400 wrqu.data.length = 0;
4401 wrqu.data.flags = 0;
4402 wireless_send_event(priv->net_dev, SIOCGIWSCAN, &wrqu, NULL);
4403 }
4404}
4405
James Ketrenos43f66a62005-03-25 12:31:53 -06004406/**
4407 * Handle host notification packet.
4408 * Called from interrupt routine
4409 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004410static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004411 struct ipw_rx_notification *notif)
4412{
John W. Linville9387b7c2008-09-30 20:59:05 -04004413 DECLARE_SSID_BUF(ssid);
Al Viroe62e1ee2007-12-27 01:36:46 -05004414 u16 size = le16_to_cpu(notif->size);
James Ketrenosa613bff2005-08-24 21:43:11 -05004415
Al Viroe62e1ee2007-12-27 01:36:46 -05004416 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004417
James Ketrenos43f66a62005-03-25 12:31:53 -06004418 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004419 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4420 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004421
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004422 switch (assoc->state) {
4423 case CMAS_ASSOCIATED:{
4424 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4425 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004426 "associated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004427 print_ssid(ssid, priv->essid,
4428 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004429 priv->bssid);
Jeff Garzikbf794512005-07-31 13:07:26 -04004430
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004431 switch (priv->ieee->iw_mode) {
4432 case IW_MODE_INFRA:
4433 memcpy(priv->ieee->bssid,
4434 priv->bssid, ETH_ALEN);
4435 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004436
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004437 case IW_MODE_ADHOC:
4438 memcpy(priv->ieee->bssid,
4439 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004440
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004441 /* clear out the station table */
4442 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004443
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004444 IPW_DEBUG_ASSOC
4445 ("queueing adhoc check\n");
4446 queue_delayed_work(priv->
4447 workqueue,
4448 &priv->
4449 adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05004450 le16_to_cpu(priv->
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004451 assoc_request.
Al Viro5b5e8072007-12-27 01:54:06 -05004452 beacon_interval));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004453 break;
4454 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004455
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004456 priv->status &= ~STATUS_ASSOCIATING;
4457 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004458 queue_work(priv->workqueue,
4459 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004460
Zhu Yie43e3c12006-04-13 17:20:45 +08004461#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004462#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
John W. Linville72118012008-09-30 21:43:03 -04004463 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_control))
James Ketrenosafbf30a2005-08-25 00:05:33 -05004464 if ((priv->status & STATUS_AUTH) &&
4465 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4466 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004467 if ((sizeof
4468 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004469 ieee80211_assoc_response)
Al Viroe62e1ee2007-12-27 01:36:46 -05004470 <= size)
4471 && (size <= 2314)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004472 struct
4473 ieee80211_rx_stats
4474 stats = {
Al Viroe62e1ee2007-12-27 01:36:46 -05004475 .len = size - 1,
James Ketrenosb095c382005-08-24 22:04:42 -05004476 };
4477
4478 IPW_DEBUG_QOS
4479 ("QoS Associate "
Al Viroe62e1ee2007-12-27 01:36:46 -05004480 "size %d\n", size);
James Ketrenosb095c382005-08-24 22:04:42 -05004481 ieee80211_rx_mgt(priv->
4482 ieee,
4483 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004484 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004485 *)
4486 &notif->u.raw, &stats);
4487 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004488 }
James Ketrenosb095c382005-08-24 22:04:42 -05004489#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004490
James Ketrenosa613bff2005-08-24 21:43:11 -05004491 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004492
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004493 break;
4494 }
4495
4496 case CMAS_AUTHENTICATED:{
4497 if (priv->
4498 status & (STATUS_ASSOCIATED |
4499 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004500 struct notif_authenticate *auth
4501 = &notif->u.auth;
4502 IPW_DEBUG(IPW_DL_NOTIF |
4503 IPW_DL_STATE |
4504 IPW_DL_ASSOC,
4505 "deauthenticated: '%s' "
Johannes Berge1749612008-10-27 15:59:26 -07004506 "%pM"
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004507 ": (0x%04X) - %s \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004508 print_ssid(ssid,
4509 priv->
4510 essid,
4511 priv->
4512 essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004513 priv->bssid,
Al Viro83f7d572008-03-16 22:26:44 +00004514 le16_to_cpu(auth->status),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004515 ipw_get_status_code
Al Viro83f7d572008-03-16 22:26:44 +00004516 (le16_to_cpu
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004517 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004518
4519 priv->status &=
4520 ~(STATUS_ASSOCIATING |
4521 STATUS_AUTH |
4522 STATUS_ASSOCIATED);
4523
James Ketrenosa613bff2005-08-24 21:43:11 -05004524 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004525 break;
4526 }
4527
4528 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4529 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004530 "authenticated: '%s' %pM\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004531 print_ssid(ssid, priv->essid,
4532 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004533 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004534 break;
4535 }
4536
4537 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004538 if (priv->status & STATUS_AUTH) {
4539 struct
4540 ieee80211_assoc_response
4541 *resp;
4542 resp =
4543 (struct
4544 ieee80211_assoc_response
4545 *)&notif->u.raw;
4546 IPW_DEBUG(IPW_DL_NOTIF |
4547 IPW_DL_STATE |
4548 IPW_DL_ASSOC,
4549 "association failed (0x%04X): %s\n",
Al Viro83f7d572008-03-16 22:26:44 +00004550 le16_to_cpu(resp->status),
James Ketrenosea2b26e2005-08-24 21:25:16 -05004551 ipw_get_status_code
Al Viro83f7d572008-03-16 22:26:44 +00004552 (le16_to_cpu
James Ketrenosea2b26e2005-08-24 21:25:16 -05004553 (resp->status)));
4554 }
4555
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004556 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4557 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004558 "disassociated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004559 print_ssid(ssid, priv->essid,
4560 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004561 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004562
4563 priv->status &=
4564 ~(STATUS_DISASSOCIATING |
4565 STATUS_ASSOCIATING |
4566 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004567 if (priv->assoc_network
4568 && (priv->assoc_network->
4569 capability &
4570 WLAN_CAPABILITY_IBSS))
4571 ipw_remove_current_network
4572 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004573
James Ketrenosa613bff2005-08-24 21:43:11 -05004574 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004575
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004576 break;
4577 }
4578
James Ketrenosb095c382005-08-24 22:04:42 -05004579 case CMAS_RX_ASSOC_RESP:
4580 break;
4581
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004582 default:
4583 IPW_ERROR("assoc: unknown (%d)\n",
4584 assoc->state);
4585 break;
4586 }
4587
James Ketrenos43f66a62005-03-25 12:31:53 -06004588 break;
4589 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004590
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004591 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4592 struct notif_authenticate *auth = &notif->u.auth;
4593 switch (auth->state) {
4594 case CMAS_AUTHENTICATED:
4595 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Johannes Berge1749612008-10-27 15:59:26 -07004596 "authenticated: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004597 print_ssid(ssid, priv->essid,
4598 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004599 priv->bssid);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004600 priv->status |= STATUS_AUTH;
4601 break;
4602
4603 case CMAS_INIT:
4604 if (priv->status & STATUS_AUTH) {
4605 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4606 IPW_DL_ASSOC,
4607 "authentication failed (0x%04X): %s\n",
Al Viro83f7d572008-03-16 22:26:44 +00004608 le16_to_cpu(auth->status),
4609 ipw_get_status_code(le16_to_cpu
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004610 (auth->
4611 status)));
4612 }
4613 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4614 IPW_DL_ASSOC,
Johannes Berge1749612008-10-27 15:59:26 -07004615 "deauthenticated: '%s' %pM\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04004616 print_ssid(ssid, priv->essid,
4617 priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07004618 priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06004619
4620 priv->status &= ~(STATUS_ASSOCIATING |
4621 STATUS_AUTH |
4622 STATUS_ASSOCIATED);
4623
James Ketrenosa613bff2005-08-24 21:43:11 -05004624 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004625 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004626
4627 case CMAS_TX_AUTH_SEQ_1:
4628 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4629 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4630 break;
4631 case CMAS_RX_AUTH_SEQ_2:
4632 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4633 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4634 break;
4635 case CMAS_AUTH_SEQ_1_PASS:
4636 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4637 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4638 break;
4639 case CMAS_AUTH_SEQ_1_FAIL:
4640 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4641 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4642 break;
4643 case CMAS_TX_AUTH_SEQ_3:
4644 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4645 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4646 break;
4647 case CMAS_RX_AUTH_SEQ_4:
4648 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4649 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4650 break;
4651 case CMAS_AUTH_SEQ_2_PASS:
4652 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4653 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4654 break;
4655 case CMAS_AUTH_SEQ_2_FAIL:
4656 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4657 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4658 break;
4659 case CMAS_TX_ASSOC:
4660 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4661 IPW_DL_ASSOC, "TX_ASSOC\n");
4662 break;
4663 case CMAS_RX_ASSOC_RESP:
4664 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4665 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004666
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004667 break;
4668 case CMAS_ASSOCIATED:
4669 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4670 IPW_DL_ASSOC, "ASSOCIATED\n");
4671 break;
4672 default:
4673 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4674 auth->state);
4675 break;
4676 }
4677 break;
4678 }
4679
4680 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4681 struct notif_channel_result *x =
4682 &notif->u.channel_result;
4683
Al Viroe62e1ee2007-12-27 01:36:46 -05004684 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004685 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4686 x->channel_num);
4687 } else {
4688 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4689 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004690 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004691 }
4692 break;
4693 }
4694
4695 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4696 struct notif_scan_complete *x = &notif->u.scan_complete;
Al Viroe62e1ee2007-12-27 01:36:46 -05004697 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004698 IPW_DEBUG_SCAN
4699 ("Scan completed: type %d, %d channels, "
4700 "%d status\n", x->scan_type,
4701 x->num_channels, x->status);
4702 } else {
4703 IPW_ERROR("Scan completed of wrong size %d "
4704 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004705 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004706 }
4707
4708 priv->status &=
4709 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4710
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004711 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004712 cancel_delayed_work(&priv->scan_check);
4713
James Ketrenosb095c382005-08-24 22:04:42 -05004714 if (priv->status & STATUS_EXIT_PENDING)
4715 break;
4716
4717 priv->ieee->scans++;
4718
4719#ifdef CONFIG_IPW2200_MONITOR
4720 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004721 priv->status |= STATUS_SCAN_FORCED;
David Howellsc4028952006-11-22 14:57:56 +00004722 queue_delayed_work(priv->workqueue,
4723 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05004724 break;
4725 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004726 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004727#endif /* CONFIG_IPW2200_MONITOR */
4728
Dan Williamsea177302008-06-02 17:51:23 -04004729 /* Do queued direct scans first */
4730 if (priv->status & STATUS_DIRECT_SCAN_PENDING) {
4731 queue_delayed_work(priv->workqueue,
4732 &priv->request_direct_scan, 0);
4733 }
4734
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004735 if (!(priv->status & (STATUS_ASSOCIATED |
4736 STATUS_ASSOCIATING |
4737 STATUS_ROAMING |
4738 STATUS_DISASSOCIATING)))
4739 queue_work(priv->workqueue, &priv->associate);
4740 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004741 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4742 /* If a scan completed and we are in roam mode, then
4743 * the scan that completed was the one requested as a
4744 * result of entering roam... so, schedule the
4745 * roam work */
4746 queue_work(priv->workqueue,
4747 &priv->roam);
4748 else
4749 /* Don't schedule if we aborted the scan */
4750 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004751 } else if (priv->status & STATUS_SCAN_PENDING)
David Howellsc4028952006-11-22 14:57:56 +00004752 queue_delayed_work(priv->workqueue,
4753 &priv->request_scan, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05004754 else if (priv->config & CFG_BACKGROUND_SCAN
4755 && priv->status & STATUS_ASSOCIATED)
4756 queue_delayed_work(priv->workqueue,
Stephen Hemminger1c9d5e42007-06-22 21:34:06 -07004757 &priv->request_scan,
Anton Blanchardbe84e3d2007-10-15 00:38:01 -05004758 round_jiffies_relative(HZ));
Zhu Yi07f02e42006-04-13 17:19:25 +08004759
4760 /* Send an empty event to user space.
4761 * We don't send the received data on the event because
4762 * it would require us to do complex transcoding, and
4763 * we want to minimise the work done in the irq handler
4764 * Use a request to extract the data.
4765 * Also, we generate this even for any scan, regardless
4766 * on how the scan was initiated. User space can just
4767 * sync on periodic scan to get fresh data...
4768 * Jean II */
Dan Williams0b531672007-10-09 13:55:24 -04004769 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4770 handle_scan_event(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004771 break;
4772 }
4773
4774 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4775 struct notif_frag_length *x = &notif->u.frag_len;
4776
Al Viroe62e1ee2007-12-27 01:36:46 -05004777 if (size == sizeof(*x))
James Ketrenosa613bff2005-08-24 21:43:11 -05004778 IPW_ERROR("Frag length: %d\n",
4779 le16_to_cpu(x->frag_length));
4780 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004781 IPW_ERROR("Frag length of wrong size %d "
4782 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004783 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004784 break;
4785 }
4786
4787 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4788 struct notif_link_deterioration *x =
4789 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004790
Al Viroe62e1ee2007-12-27 01:36:46 -05004791 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004792 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004793 "link deterioration: type %d, cnt %d\n",
4794 x->silence_notification_type,
4795 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004796 memcpy(&priv->last_link_deterioration, x,
4797 sizeof(*x));
4798 } else {
4799 IPW_ERROR("Link Deterioration of wrong size %d "
4800 "(should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004801 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004802 }
4803 break;
4804 }
4805
4806 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4807 IPW_ERROR("Dino config\n");
4808 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004809 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004810 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004811
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004812 break;
4813 }
4814
4815 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4816 struct notif_beacon_state *x = &notif->u.beacon_state;
Al Viroe62e1ee2007-12-27 01:36:46 -05004817 if (size != sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004818 IPW_ERROR
4819 ("Beacon state of wrong size %d (should "
Al Viroe62e1ee2007-12-27 01:36:46 -05004820 "be %zd)\n", size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004821 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004822 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004823
James Ketrenosa613bff2005-08-24 21:43:11 -05004824 if (le32_to_cpu(x->state) ==
4825 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4826 ipw_handle_missed_beacon(priv,
4827 le32_to_cpu(x->
4828 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004829
James Ketrenos43f66a62005-03-25 12:31:53 -06004830 break;
4831 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004832
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004833 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4834 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
Al Viroe62e1ee2007-12-27 01:36:46 -05004835 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004836 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4837 "0x%02x station %d\n",
4838 x->key_state, x->security_type,
4839 x->station_index);
4840 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004841 }
4842
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004843 IPW_ERROR
4844 ("TGi Tx Key of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004845 size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004846 break;
4847 }
4848
4849 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4850 struct notif_calibration *x = &notif->u.calibration;
4851
Al Viroe62e1ee2007-12-27 01:36:46 -05004852 if (size == sizeof(*x)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004853 memcpy(&priv->calib, x, sizeof(*x));
4854 IPW_DEBUG_INFO("TODO: Calibration\n");
4855 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004856 }
4857
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004858 IPW_ERROR
4859 ("Calibration of wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004860 size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004861 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004862 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004863
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004864 case HOST_NOTIFICATION_NOISE_STATS:{
Al Viroe62e1ee2007-12-27 01:36:46 -05004865 if (size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004866 priv->exp_avg_noise =
4867 exponential_average(priv->exp_avg_noise,
4868 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4869 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004870 break;
4871 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004872
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004873 IPW_ERROR
4874 ("Noise stat is wrong size %d (should be %zd)\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004875 size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004876 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004877 }
4878
James Ketrenos43f66a62005-03-25 12:31:53 -06004879 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004880 IPW_DEBUG_NOTIF("Unknown notification: "
4881 "subtype=%d,flags=0x%2x,size=%d\n",
Al Viroe62e1ee2007-12-27 01:36:46 -05004882 notif->subtype, notif->flags, size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004883 }
4884}
4885
4886/**
4887 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004888 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004889 * @param priv
4890 * @return error code
4891 */
4892static int ipw_queue_reset(struct ipw_priv *priv)
4893{
4894 int rc = 0;
4895 /** @todo customize queue sizes */
4896 int nTx = 64, nTxCmd = 8;
4897 ipw_tx_queue_free(priv);
4898 /* Tx CMD queue */
4899 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004900 IPW_TX_CMD_QUEUE_READ_INDEX,
4901 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4902 IPW_TX_CMD_QUEUE_BD_BASE,
4903 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004904 if (rc) {
4905 IPW_ERROR("Tx Cmd queue init failed\n");
4906 goto error;
4907 }
4908 /* Tx queue(s) */
4909 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004910 IPW_TX_QUEUE_0_READ_INDEX,
4911 IPW_TX_QUEUE_0_WRITE_INDEX,
4912 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004913 if (rc) {
4914 IPW_ERROR("Tx 0 queue init failed\n");
4915 goto error;
4916 }
4917 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004918 IPW_TX_QUEUE_1_READ_INDEX,
4919 IPW_TX_QUEUE_1_WRITE_INDEX,
4920 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004921 if (rc) {
4922 IPW_ERROR("Tx 1 queue init failed\n");
4923 goto error;
4924 }
4925 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004926 IPW_TX_QUEUE_2_READ_INDEX,
4927 IPW_TX_QUEUE_2_WRITE_INDEX,
4928 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004929 if (rc) {
4930 IPW_ERROR("Tx 2 queue init failed\n");
4931 goto error;
4932 }
4933 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004934 IPW_TX_QUEUE_3_READ_INDEX,
4935 IPW_TX_QUEUE_3_WRITE_INDEX,
4936 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004937 if (rc) {
4938 IPW_ERROR("Tx 3 queue init failed\n");
4939 goto error;
4940 }
4941 /* statistics */
4942 priv->rx_bufs_min = 0;
4943 priv->rx_pend_max = 0;
4944 return rc;
4945
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004946 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004947 ipw_tx_queue_free(priv);
4948 return rc;
4949}
4950
4951/**
4952 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004953 *
Stefano Brivio8ff9d212008-01-12 23:12:26 +01004954 * When FW advances 'R' index, all entries between old and
James Ketrenos43f66a62005-03-25 12:31:53 -06004955 * new 'R' index need to be reclaimed. As result, some free space
4956 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004957 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004958 * @note Need to protect against garbage in 'R' index
4959 * @param priv
4960 * @param txq
4961 * @param qindex
4962 * @return Number of used entries remains in the queue
4963 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004964static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004965 struct clx2_tx_queue *txq, int qindex)
4966{
4967 u32 hw_tail;
4968 int used;
4969 struct clx2_queue *q = &txq->q;
4970
4971 hw_tail = ipw_read32(priv, q->reg_r);
4972 if (hw_tail >= q->n_bd) {
4973 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004974 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4975 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004976 goto done;
4977 }
4978 for (; q->last_used != hw_tail;
4979 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4980 ipw_queue_tx_free_tfd(priv, txq);
4981 priv->tx_packets++;
4982 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004983 done:
Dan Williams943dbef2008-02-14 17:49:41 -05004984 if ((ipw_tx_queue_space(q) > q->low_mark) &&
David S. Miller521c4d92008-07-22 18:32:47 -07004985 (qindex >= 0))
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004986 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004987 used = q->first_empty - q->last_used;
4988 if (used < 0)
4989 used += q->n_bd;
4990
4991 return used;
4992}
4993
4994static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4995 int len, int sync)
4996{
4997 struct clx2_tx_queue *txq = &priv->txq_cmd;
4998 struct clx2_queue *q = &txq->q;
4999 struct tfd_frame *tfd;
5000
Dan Williams943dbef2008-02-14 17:49:41 -05005001 if (ipw_tx_queue_space(q) < (sync ? 1 : 2)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005002 IPW_ERROR("No space for Tx\n");
5003 return -EBUSY;
5004 }
5005
5006 tfd = &txq->bd[q->first_empty];
5007 txq->txb[q->first_empty] = NULL;
5008
5009 memset(tfd, 0, sizeof(*tfd));
5010 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
5011 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
5012 priv->hcmd_seq++;
5013 tfd->u.cmd.index = hcmd;
5014 tfd->u.cmd.length = len;
5015 memcpy(tfd->u.cmd.payload, buf, len);
5016 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
5017 ipw_write32(priv, q->reg_w, q->first_empty);
5018 _ipw_read32(priv, 0x90);
5019
5020 return 0;
5021}
5022
Jeff Garzikbf794512005-07-31 13:07:26 -04005023/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005024 * Rx theory of operation
5025 *
5026 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05005027 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06005028 * 0 to 31
5029 *
5030 * Rx Queue Indexes
5031 * The host/firmware share two index registers for managing the Rx buffers.
5032 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005033 * The READ index maps to the first position that the firmware may be writing
5034 * to -- the driver can read up to (but not including) this position and get
5035 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06005036 * The READ index is managed by the firmware once the card is enabled.
5037 *
5038 * The WRITE index maps to the last position the driver has read from -- the
5039 * position preceding WRITE is the last slot the firmware can place a packet.
5040 *
5041 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04005042 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06005043 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005044 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06005045 * INDEX position, and WRITE to the last (READ - 1 wrapped)
5046 *
5047 * When the firmware places a packet in a buffer it will advance the READ index
5048 * and fire the RX interrupt. The driver can then query the READ index and
5049 * process as many packets as possible, moving the WRITE index forward as it
5050 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04005051 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005052 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04005053 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06005054 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04005055 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06005056 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
5057 * ipw->rxq is replenished and the READ INDEX is updated (updating the
5058 * 'processed' and 'read' driver indexes as well)
5059 * + A received packet is processed and handed to the kernel network stack,
5060 * detached from the ipw->rxq. The driver 'processed' index is updated.
5061 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04005062 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
5063 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06005064 * were enough free buffers and RX_STALLED is set it is cleared.
5065 *
5066 *
5067 * Driver sequence:
5068 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005069 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06005070 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
5071 * ipw_rx_queue_restock
5072 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
5073 * queue, updates firmware pointers, and updates
5074 * the WRITE index. If insufficient rx_free buffers
5075 * are available, schedules ipw_rx_queue_replenish
5076 *
5077 * -- enable interrupts --
5078 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04005079 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06005080 * Moves the packet buffer from queue to rx_used.
5081 * Calls ipw_rx_queue_restock to refill any empty
5082 * slots.
5083 * ...
5084 *
5085 */
5086
Jeff Garzikbf794512005-07-31 13:07:26 -04005087/*
James Ketrenos43f66a62005-03-25 12:31:53 -06005088 * If there are slots in the RX queue that need to be restocked,
5089 * and we have free pre-allocated buffers, fill the ranks as much
5090 * as we can pulling from rx_free.
5091 *
5092 * This moves the 'write' index forward to catch up with 'processed', and
5093 * also updates the memory address in the firmware to reference the new
5094 * target buffer.
5095 */
5096static void ipw_rx_queue_restock(struct ipw_priv *priv)
5097{
5098 struct ipw_rx_queue *rxq = priv->rxq;
5099 struct list_head *element;
5100 struct ipw_rx_mem_buffer *rxb;
5101 unsigned long flags;
5102 int write;
5103
5104 spin_lock_irqsave(&rxq->lock, flags);
5105 write = rxq->write;
Dan Williams943dbef2008-02-14 17:49:41 -05005106 while ((ipw_rx_queue_space(rxq) > 0) && (rxq->free_count)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005107 element = rxq->rx_free.next;
5108 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
5109 list_del(element);
5110
James Ketrenosb095c382005-08-24 22:04:42 -05005111 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005112 rxb->dma_addr);
5113 rxq->queue[rxq->write] = rxb;
5114 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5115 rxq->free_count--;
5116 }
5117 spin_unlock_irqrestore(&rxq->lock, flags);
5118
Jeff Garzikbf794512005-07-31 13:07:26 -04005119 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005120 * refill it */
5121 if (rxq->free_count <= RX_LOW_WATERMARK)
5122 queue_work(priv->workqueue, &priv->rx_replenish);
5123
5124 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005125 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005126 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005127}
5128
5129/*
5130 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005131 * Also restock the Rx queue via ipw_rx_queue_restock.
5132 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005133 * This is called as a scheduled work item (except for during intialization)
5134 */
5135static void ipw_rx_queue_replenish(void *data)
5136{
5137 struct ipw_priv *priv = data;
5138 struct ipw_rx_queue *rxq = priv->rxq;
5139 struct list_head *element;
5140 struct ipw_rx_mem_buffer *rxb;
5141 unsigned long flags;
5142
5143 spin_lock_irqsave(&rxq->lock, flags);
5144 while (!list_empty(&rxq->rx_used)) {
5145 element = rxq->rx_used.next;
5146 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005147 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005148 if (!rxb->skb) {
5149 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5150 priv->net_dev->name);
5151 /* We don't reschedule replenish work here -- we will
5152 * call the restock method and if it still needs
5153 * more buffers it will schedule replenish */
5154 break;
5155 }
5156 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005157
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005158 rxb->dma_addr =
5159 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005160 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005161
James Ketrenos43f66a62005-03-25 12:31:53 -06005162 list_add_tail(&rxb->list, &rxq->rx_free);
5163 rxq->free_count++;
5164 }
5165 spin_unlock_irqrestore(&rxq->lock, flags);
5166
5167 ipw_rx_queue_restock(priv);
5168}
5169
David Howellsc4028952006-11-22 14:57:56 +00005170static void ipw_bg_rx_queue_replenish(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005171{
David Howellsc4028952006-11-22 14:57:56 +00005172 struct ipw_priv *priv =
5173 container_of(work, struct ipw_priv, rx_replenish);
Zhu Yi46441512006-01-24 16:37:59 +08005174 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00005175 ipw_rx_queue_replenish(priv);
Zhu Yi46441512006-01-24 16:37:59 +08005176 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005177}
5178
James Ketrenos43f66a62005-03-25 12:31:53 -06005179/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005180 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005181 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005182 * non NULL it is unmapped and freed
5183 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005184static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005185{
5186 int i;
5187
5188 if (!rxq)
5189 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005190
James Ketrenos43f66a62005-03-25 12:31:53 -06005191 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5192 if (rxq->pool[i].skb != NULL) {
5193 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005194 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005195 dev_kfree_skb(rxq->pool[i].skb);
5196 }
5197 }
5198
5199 kfree(rxq);
5200}
5201
5202static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5203{
5204 struct ipw_rx_queue *rxq;
5205 int i;
5206
Takisc75f4742005-12-01 01:41:45 -08005207 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005208 if (unlikely(!rxq)) {
5209 IPW_ERROR("memory allocation failed\n");
5210 return NULL;
5211 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005212 spin_lock_init(&rxq->lock);
5213 INIT_LIST_HEAD(&rxq->rx_free);
5214 INIT_LIST_HEAD(&rxq->rx_used);
5215
5216 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005217 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005218 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5219
5220 /* Set us so that we have processed and used all buffers, but have
5221 * not restocked the Rx queue with fresh buffers */
5222 rxq->read = rxq->write = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005223 rxq->free_count = 0;
5224
5225 return rxq;
5226}
5227
5228static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5229{
5230 rate &= ~IEEE80211_BASIC_RATE_MASK;
5231 if (ieee_mode == IEEE_A) {
5232 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005233 case IEEE80211_OFDM_RATE_6MB:
5234 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005235 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005236 case IEEE80211_OFDM_RATE_9MB:
5237 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005238 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005239 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005240 return priv->
5241 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005242 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005243 return priv->
5244 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005245 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005246 return priv->
5247 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005248 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005249 return priv->
5250 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005251 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005252 return priv->
5253 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005254 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005255 return priv->
5256 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005257 default:
5258 return 0;
5259 }
5260 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005261
James Ketrenos43f66a62005-03-25 12:31:53 -06005262 /* B and G mixed */
5263 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005264 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005265 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005266 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005267 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005268 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005269 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005270 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005271 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5272 }
5273
5274 /* If we are limited to B modulations, bail at this point */
5275 if (ieee_mode == IEEE_B)
5276 return 0;
5277
5278 /* G */
5279 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005280 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005281 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005282 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005283 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005284 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005285 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005286 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005287 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005288 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005289 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005290 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005291 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005292 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005293 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005294 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005295 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5296 }
5297
5298 return 0;
5299}
5300
Jeff Garzikbf794512005-07-31 13:07:26 -04005301static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005302 const struct ieee80211_network *network,
5303 struct ipw_supported_rates *rates)
5304{
5305 int num_rates, i;
5306
5307 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005308 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005309 rates->num_rates = 0;
5310 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005311 if (!ipw_is_rate_in_mask(priv, network->mode,
5312 network->rates[i])) {
5313
James Ketrenosea2b26e2005-08-24 21:25:16 -05005314 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005315 IPW_DEBUG_SCAN("Adding masked mandatory "
5316 "rate %02X\n",
5317 network->rates[i]);
5318 rates->supported_rates[rates->num_rates++] =
5319 network->rates[i];
5320 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005321 }
5322
James Ketrenos43f66a62005-03-25 12:31:53 -06005323 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5324 network->rates[i], priv->rates_mask);
5325 continue;
5326 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005327
James Ketrenos43f66a62005-03-25 12:31:53 -06005328 rates->supported_rates[rates->num_rates++] = network->rates[i];
5329 }
5330
James Ketrenosa613bff2005-08-24 21:43:11 -05005331 num_rates = min(network->rates_ex_len,
5332 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005333 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005334 if (!ipw_is_rate_in_mask(priv, network->mode,
5335 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005336 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005337 IPW_DEBUG_SCAN("Adding masked mandatory "
5338 "rate %02X\n",
5339 network->rates_ex[i]);
5340 rates->supported_rates[rates->num_rates++] =
5341 network->rates[i];
5342 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005343 }
5344
James Ketrenos43f66a62005-03-25 12:31:53 -06005345 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5346 network->rates_ex[i], priv->rates_mask);
5347 continue;
5348 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005349
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005350 rates->supported_rates[rates->num_rates++] =
5351 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005352 }
5353
James Ketrenosea2b26e2005-08-24 21:25:16 -05005354 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005355}
5356
Arjan van de Ven858119e2006-01-14 13:20:43 -08005357static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005358 const struct ipw_supported_rates *src)
5359{
5360 u8 i;
5361 for (i = 0; i < src->num_rates; i++)
5362 dest->supported_rates[i] = src->supported_rates[i];
5363 dest->num_rates = src->num_rates;
5364}
5365
5366/* TODO: Look at sniffed packets in the air to determine if the basic rate
5367 * mask should ever be used -- right now all callers to add the scan rates are
5368 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5369static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005370 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005371{
Jeff Garzikbf794512005-07-31 13:07:26 -04005372 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005373 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005374
James Ketrenos43f66a62005-03-25 12:31:53 -06005375 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005376 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005377 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005378
5379 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005380 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005381 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005382
5383 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005384 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005385 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005386
5387 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005388 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005389 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005390}
5391
5392static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005393 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005394{
Jeff Garzikbf794512005-07-31 13:07:26 -04005395 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005396 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005397
5398 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005399 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005400 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005401
5402 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005403 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005404 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005405
5406 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005407 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005408 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005409
5410 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005411 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005412 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005413
5414 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005415 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005416 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005417
5418 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005419 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005420 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005421
5422 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005423 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005424 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005425
5426 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005427 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005428 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005429}
5430
5431struct ipw_network_match {
5432 struct ieee80211_network *network;
5433 struct ipw_supported_rates rates;
5434};
5435
James Ketrenosc848d0a2005-08-24 21:56:24 -05005436static int ipw_find_adhoc_network(struct ipw_priv *priv,
5437 struct ipw_network_match *match,
5438 struct ieee80211_network *network,
5439 int roaming)
5440{
5441 struct ipw_supported_rates rates;
John W. Linville9387b7c2008-09-30 20:59:05 -04005442 DECLARE_SSID_BUF(ssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005443
5444 /* Verify that this network's capability is compatible with the
5445 * current mode (AdHoc or Infrastructure) */
5446 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5447 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Johannes Berge1749612008-10-27 15:59:26 -07005448 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded due to "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005449 "capability mismatch.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005450 print_ssid(ssid, network->ssid,
5451 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005452 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005453 return 0;
5454 }
5455
James Ketrenosc848d0a2005-08-24 21:56:24 -05005456 if (unlikely(roaming)) {
5457 /* If we are roaming, then ensure check if this is a valid
5458 * network to try and roam to */
5459 if ((network->ssid_len != match->network->ssid_len) ||
5460 memcmp(network->ssid, match->network->ssid,
5461 network->ssid_len)) {
Johannes Berge1749612008-10-27 15:59:26 -07005462 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005463 "because of non-network ESSID.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005464 print_ssid(ssid, network->ssid,
5465 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005466 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005467 return 0;
5468 }
5469 } else {
5470 /* If an ESSID has been configured then compare the broadcast
5471 * ESSID to ours */
5472 if ((priv->config & CFG_STATIC_ESSID) &&
5473 ((network->ssid_len != priv->essid_len) ||
5474 memcmp(network->ssid, priv->essid,
5475 min(network->ssid_len, priv->essid_len)))) {
5476 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005477
James Ketrenosc848d0a2005-08-24 21:56:24 -05005478 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005479 print_ssid(ssid, network->ssid,
5480 network->ssid_len),
James Ketrenosc848d0a2005-08-24 21:56:24 -05005481 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005482 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005483 "because of ESSID mismatch: '%s'.\n",
Johannes Berge1749612008-10-27 15:59:26 -07005484 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005485 print_ssid(ssid, priv->essid,
5486 priv->essid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005487 return 0;
5488 }
5489 }
5490
5491 /* If the old network rate is better than this one, don't bother
5492 * testing everything else. */
5493
5494 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005495 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5496 "current network.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005497 print_ssid(ssid, match->network->ssid,
5498 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005499 return 0;
5500 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005501 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5502 "current network.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005503 print_ssid(ssid, match->network->ssid,
5504 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005505 return 0;
5506 }
5507
5508 /* Now go through and see if the requested network is valid... */
5509 if (priv->ieee->scan_age != 0 &&
5510 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Johannes Berge1749612008-10-27 15:59:26 -07005511 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005512 "because of age: %ums.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005513 print_ssid(ssid, network->ssid,
5514 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005515 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005516 jiffies_to_msecs(jiffies -
5517 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005518 return 0;
5519 }
5520
5521 if ((priv->config & CFG_STATIC_CHANNEL) &&
5522 (network->channel != priv->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005523 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005524 "because of channel mismatch: %d != %d.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005525 print_ssid(ssid, network->ssid,
5526 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005527 network->bssid,
James Ketrenosc848d0a2005-08-24 21:56:24 -05005528 network->channel, priv->channel);
5529 return 0;
5530 }
5531
5532 /* Verify privacy compatability */
5533 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5534 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Johannes Berge1749612008-10-27 15:59:26 -07005535 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005536 "because of privacy mismatch: %s != %s.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005537 print_ssid(ssid, network->ssid,
5538 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005539 network->bssid,
James Ketrenosafbf30a2005-08-25 00:05:33 -05005540 priv->
5541 capability & CAP_PRIVACY_ON ? "on" : "off",
5542 network->
5543 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5544 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005545 return 0;
5546 }
5547
5548 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Johannes Berge1749612008-10-27 15:59:26 -07005549 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
5550 "because of the same BSSID match: %pM"
John W. Linville9387b7c2008-09-30 20:59:05 -04005551 ".\n", print_ssid(ssid, network->ssid,
5552 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005553 network->bssid,
5554 priv->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005555 return 0;
5556 }
5557
5558 /* Filter out any incompatible freq / mode combinations */
5559 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Johannes Berge1749612008-10-27 15:59:26 -07005560 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005561 "because of invalid frequency/mode "
5562 "combination.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005563 print_ssid(ssid, network->ssid,
5564 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005565 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005566 return 0;
5567 }
5568
5569 /* Ensure that the rates supported by the driver are compatible with
5570 * this AP, including verification of basic rates (mandatory) */
5571 if (!ipw_compatible_rates(priv, network, &rates)) {
Johannes Berge1749612008-10-27 15:59:26 -07005572 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005573 "because configured rate mask excludes "
5574 "AP mandatory rate.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005575 print_ssid(ssid, network->ssid,
5576 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005577 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005578 return 0;
5579 }
5580
5581 if (rates.num_rates == 0) {
Johannes Berge1749612008-10-27 15:59:26 -07005582 IPW_DEBUG_MERGE("Network '%s (%pM)' excluded "
James Ketrenosc848d0a2005-08-24 21:56:24 -05005583 "because of no compatible rates.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005584 print_ssid(ssid, network->ssid,
5585 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005586 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005587 return 0;
5588 }
5589
5590 /* TODO: Perform any further minimal comparititive tests. We do not
5591 * want to put too much policy logic here; intelligent scan selection
5592 * should occur within a generic IEEE 802.11 user space tool. */
5593
5594 /* Set up 'new' AP to this network */
5595 ipw_copy_rates(&match->rates, &rates);
5596 match->network = network;
Johannes Berge1749612008-10-27 15:59:26 -07005597 IPW_DEBUG_MERGE("Network '%s (%pM)' is a viable match.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005598 print_ssid(ssid, network->ssid, network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005599 network->bssid);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005600
5601 return 1;
5602}
5603
David Howellsc4028952006-11-22 14:57:56 +00005604static void ipw_merge_adhoc_network(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05005605{
John W. Linville9387b7c2008-09-30 20:59:05 -04005606 DECLARE_SSID_BUF(ssid);
David Howellsc4028952006-11-22 14:57:56 +00005607 struct ipw_priv *priv =
5608 container_of(work, struct ipw_priv, merge_networks);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005609 struct ieee80211_network *network = NULL;
5610 struct ipw_network_match match = {
5611 .network = priv->assoc_network
5612 };
5613
James Ketrenosafbf30a2005-08-25 00:05:33 -05005614 if ((priv->status & STATUS_ASSOCIATED) &&
5615 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005616 /* First pass through ROAM process -- look for a better
5617 * network */
5618 unsigned long flags;
5619
5620 spin_lock_irqsave(&priv->ieee->lock, flags);
5621 list_for_each_entry(network, &priv->ieee->network_list, list) {
5622 if (network != priv->assoc_network)
5623 ipw_find_adhoc_network(priv, &match, network,
5624 1);
5625 }
5626 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5627
5628 if (match.network == priv->assoc_network) {
5629 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5630 "merge to.\n");
5631 return;
5632 }
5633
Zhu Yi46441512006-01-24 16:37:59 +08005634 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005635 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5636 IPW_DEBUG_MERGE("remove network %s\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005637 print_ssid(ssid, priv->essid,
5638 priv->essid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005639 ipw_remove_current_network(priv);
5640 }
5641
5642 ipw_disassociate(priv);
5643 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005644 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005645 return;
5646 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005647}
5648
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005649static int ipw_best_network(struct ipw_priv *priv,
5650 struct ipw_network_match *match,
5651 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005652{
5653 struct ipw_supported_rates rates;
John W. Linville9387b7c2008-09-30 20:59:05 -04005654 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005655
5656 /* Verify that this network's capability is compatible with the
5657 * current mode (AdHoc or Infrastructure) */
5658 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005659 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005660 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5661 !(network->capability & WLAN_CAPABILITY_IBSS))) {
Johannes Berge1749612008-10-27 15:59:26 -07005662 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005663 "capability mismatch.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005664 print_ssid(ssid, network->ssid,
5665 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005666 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005667 return 0;
5668 }
5669
James Ketrenos43f66a62005-03-25 12:31:53 -06005670 if (unlikely(roaming)) {
5671 /* If we are roaming, then ensure check if this is a valid
5672 * network to try and roam to */
5673 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005674 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005675 network->ssid_len)) {
Johannes Berge1749612008-10-27 15:59:26 -07005676 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005677 "because of non-network ESSID.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005678 print_ssid(ssid, network->ssid,
5679 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005680 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005681 return 0;
5682 }
5683 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005684 /* If an ESSID has been configured then compare the broadcast
5685 * ESSID to ours */
5686 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005687 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005688 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005689 min(network->ssid_len, priv->essid_len)))) {
5690 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005691 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005692 print_ssid(ssid, network->ssid,
5693 network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005694 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005695 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005696 "because of ESSID mismatch: '%s'.\n",
Johannes Berge1749612008-10-27 15:59:26 -07005697 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005698 print_ssid(ssid, priv->essid,
5699 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005700 return 0;
5701 }
5702 }
5703
5704 /* If the old network rate is better than this one, don't bother
5705 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005706 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005707 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005708 strncpy(escaped,
John W. Linville9387b7c2008-09-30 20:59:05 -04005709 print_ssid(ssid, network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005710 sizeof(escaped));
Johannes Berge1749612008-10-27 15:59:26 -07005711 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded because "
5712 "'%s (%pM)' has a stronger signal.\n",
5713 escaped, network->bssid,
John W. Linville9387b7c2008-09-30 20:59:05 -04005714 print_ssid(ssid, match->network->ssid,
5715 match->network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005716 match->network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005717 return 0;
5718 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005719
James Ketrenos43f66a62005-03-25 12:31:53 -06005720 /* If this network has already had an association attempt within the
5721 * last 3 seconds, do not try and associate again... */
5722 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005723 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
Johannes Berge1749612008-10-27 15:59:26 -07005724 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005725 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005726 "assoc attempt).\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005727 print_ssid(ssid, network->ssid,
5728 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005729 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005730 jiffies_to_msecs(jiffies -
5731 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005732 return 0;
5733 }
5734
5735 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005736 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005737 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
Johannes Berge1749612008-10-27 15:59:26 -07005738 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005739 "because of age: %ums.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005740 print_ssid(ssid, network->ssid,
5741 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005742 network->bssid,
Zhu Yi2638bc32006-01-24 16:37:52 +08005743 jiffies_to_msecs(jiffies -
5744 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005745 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005746 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005747
Jeff Garzikbf794512005-07-31 13:07:26 -04005748 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005749 (network->channel != priv->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005750 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005751 "because of channel mismatch: %d != %d.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005752 print_ssid(ssid, network->ssid,
5753 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005754 network->bssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005755 network->channel, priv->channel);
5756 return 0;
5757 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005758
James Ketrenos43f66a62005-03-25 12:31:53 -06005759 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005760 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005761 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
Johannes Berge1749612008-10-27 15:59:26 -07005762 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005763 "because of privacy mismatch: %s != %s.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005764 print_ssid(ssid, network->ssid,
5765 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005766 network->bssid,
Jeff Garzikbf794512005-07-31 13:07:26 -04005767 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005768 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005769 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005770 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005771 return 0;
5772 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005773
5774 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005775 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
Johannes Berge1749612008-10-27 15:59:26 -07005776 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
5777 "because of BSSID mismatch: %pM.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005778 print_ssid(ssid, network->ssid,
5779 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005780 network->bssid, priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005781 return 0;
5782 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005783
James Ketrenos43f66a62005-03-25 12:31:53 -06005784 /* Filter out any incompatible freq / mode combinations */
5785 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
Johannes Berge1749612008-10-27 15:59:26 -07005786 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005787 "because of invalid frequency/mode "
5788 "combination.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005789 print_ssid(ssid, network->ssid,
5790 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005791 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005792 return 0;
5793 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005794
Liu Hong1fe0adb2005-08-19 09:33:10 -05005795 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005796 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Johannes Berge1749612008-10-27 15:59:26 -07005797 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
Liu Hong1fe0adb2005-08-19 09:33:10 -05005798 "because of invalid channel in current GEO\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005799 print_ssid(ssid, network->ssid,
5800 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005801 network->bssid);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005802 return 0;
5803 }
5804
James Ketrenosea2b26e2005-08-24 21:25:16 -05005805 /* Ensure that the rates supported by the driver are compatible with
5806 * this AP, including verification of basic rates (mandatory) */
5807 if (!ipw_compatible_rates(priv, network, &rates)) {
Johannes Berge1749612008-10-27 15:59:26 -07005808 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenosea2b26e2005-08-24 21:25:16 -05005809 "because configured rate mask excludes "
5810 "AP mandatory rate.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005811 print_ssid(ssid, network->ssid,
5812 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005813 network->bssid);
James Ketrenosea2b26e2005-08-24 21:25:16 -05005814 return 0;
5815 }
5816
James Ketrenos43f66a62005-03-25 12:31:53 -06005817 if (rates.num_rates == 0) {
Johannes Berge1749612008-10-27 15:59:26 -07005818 IPW_DEBUG_ASSOC("Network '%s (%pM)' excluded "
James Ketrenos43f66a62005-03-25 12:31:53 -06005819 "because of no compatible rates.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005820 print_ssid(ssid, network->ssid,
5821 network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005822 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005823 return 0;
5824 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005825
James Ketrenos43f66a62005-03-25 12:31:53 -06005826 /* TODO: Perform any further minimal comparititive tests. We do not
5827 * want to put too much policy logic here; intelligent scan selection
5828 * should occur within a generic IEEE 802.11 user space tool. */
5829
5830 /* Set up 'new' AP to this network */
5831 ipw_copy_rates(&match->rates, &rates);
5832 match->network = network;
5833
Johannes Berge1749612008-10-27 15:59:26 -07005834 IPW_DEBUG_ASSOC("Network '%s (%pM)' is a viable match.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04005835 print_ssid(ssid, network->ssid, network->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07005836 network->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06005837
5838 return 1;
5839}
5840
Jeff Garzikbf794512005-07-31 13:07:26 -04005841static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005842 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005843{
Larry Finger1867b112006-02-28 09:48:28 -06005844 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005845 int i;
5846
James Ketrenos43f66a62005-03-25 12:31:53 -06005847 /*
5848 * For the purposes of scanning, we can set our wireless mode
5849 * to trigger scans across combinations of bands, but when it
5850 * comes to creating a new ad-hoc network, we have tell the FW
5851 * exactly which band to use.
5852 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005853 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005854 * chossen band. Attempting to create a new ad-hoc network
5855 * with an invalid channel for wireless mode will trigger a
5856 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005857 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005858 */
Larry Finger1867b112006-02-28 09:48:28 -06005859 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005860 case IEEE80211_52GHZ_BAND:
5861 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005862 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005863 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005864 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5865 IPW_WARNING("Overriding invalid channel\n");
5866 priv->channel = geo->a[0].channel;
5867 }
5868 break;
5869
5870 case IEEE80211_24GHZ_BAND:
5871 if (priv->ieee->mode & IEEE_G)
5872 network->mode = IEEE_G;
5873 else
5874 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005875 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005876 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005877 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5878 IPW_WARNING("Overriding invalid channel\n");
5879 priv->channel = geo->bg[0].channel;
5880 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005881 break;
5882
5883 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005884 IPW_WARNING("Overriding invalid channel\n");
5885 if (priv->ieee->mode & IEEE_A) {
5886 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005887 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005888 } else if (priv->ieee->mode & IEEE_G) {
5889 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005890 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005891 } else {
5892 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005893 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005894 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005895 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005896 }
5897
5898 network->channel = priv->channel;
5899 priv->config |= CFG_ADHOC_PERSIST;
5900 ipw_create_bssid(priv, network->bssid);
5901 network->ssid_len = priv->essid_len;
5902 memcpy(network->ssid, priv->essid, priv->essid_len);
5903 memset(&network->stats, 0, sizeof(network->stats));
5904 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005905 if (!(priv->config & CFG_PREAMBLE_LONG))
5906 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005907 if (priv->capability & CAP_PRIVACY_ON)
5908 network->capability |= WLAN_CAPABILITY_PRIVACY;
5909 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005910 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005911 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005912 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005913 &priv->rates.supported_rates[network->rates_len],
5914 network->rates_ex_len);
5915 network->last_scanned = 0;
5916 network->flags = 0;
5917 network->last_associate = 0;
5918 network->time_stamp[0] = 0;
5919 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005920 network->beacon_interval = 100; /* Default */
5921 network->listen_interval = 10; /* Default */
5922 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005923 network->wpa_ie_len = 0;
5924 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005925}
5926
James Ketrenosb095c382005-08-24 22:04:42 -05005927static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5928{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005929 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005930
5931 if (!(priv->ieee->sec.flags & (1 << index)))
5932 return;
5933
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005934 key.key_id = index;
5935 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5936 key.security_type = type;
5937 key.station_index = 0; /* always 0 for BSS */
5938 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005939 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005940 key.tx_counter[0] = cpu_to_le32(0);
5941 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005942
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005943 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005944}
5945
5946static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005947{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005948 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005949 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005950
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005951 key.cmd_id = DINO_CMD_WEP_KEY;
5952 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005953
James Ketrenosb095c382005-08-24 22:04:42 -05005954 /* Note: AES keys cannot be set for multiple times.
5955 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005956 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005957 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005958 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005959 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005960 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005961 }
5962
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005963 key.key_size = priv->ieee->sec.key_sizes[i];
5964 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005965
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005966 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005967 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005968}
5969
Zhu Yi1fbfea52005-08-05 17:22:56 +08005970static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5971{
5972 if (priv->ieee->host_encrypt)
5973 return;
5974
5975 switch (level) {
5976 case SEC_LEVEL_3:
5977 priv->sys_config.disable_unicast_decryption = 0;
5978 priv->ieee->host_decrypt = 0;
5979 break;
5980 case SEC_LEVEL_2:
5981 priv->sys_config.disable_unicast_decryption = 1;
5982 priv->ieee->host_decrypt = 1;
5983 break;
5984 case SEC_LEVEL_1:
5985 priv->sys_config.disable_unicast_decryption = 0;
5986 priv->ieee->host_decrypt = 0;
5987 break;
5988 case SEC_LEVEL_0:
5989 priv->sys_config.disable_unicast_decryption = 1;
5990 break;
5991 default:
5992 break;
5993 }
5994}
5995
5996static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5997{
5998 if (priv->ieee->host_encrypt)
5999 return;
6000
6001 switch (level) {
6002 case SEC_LEVEL_3:
6003 priv->sys_config.disable_multicast_decryption = 0;
6004 break;
6005 case SEC_LEVEL_2:
6006 priv->sys_config.disable_multicast_decryption = 1;
6007 break;
6008 case SEC_LEVEL_1:
6009 priv->sys_config.disable_multicast_decryption = 0;
6010 break;
6011 case SEC_LEVEL_0:
6012 priv->sys_config.disable_multicast_decryption = 1;
6013 break;
6014 default:
6015 break;
6016 }
6017}
6018
James Ketrenosb095c382005-08-24 22:04:42 -05006019static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
6020{
6021 switch (priv->ieee->sec.level) {
6022 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006023 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6024 ipw_send_tgi_tx_key(priv,
6025 DCT_FLAG_EXT_SECURITY_CCM,
6026 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006027
Hong Liu567deaf2005-08-31 18:07:22 +08006028 if (!priv->ieee->host_mc_decrypt)
6029 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05006030 break;
6031 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05006032 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
6033 ipw_send_tgi_tx_key(priv,
6034 DCT_FLAG_EXT_SECURITY_TKIP,
6035 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05006036 break;
6037 case SEC_LEVEL_1:
6038 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05006039 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
6040 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05006041 break;
6042 case SEC_LEVEL_0:
6043 default:
6044 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06006045 }
6046}
6047
6048static void ipw_adhoc_check(void *data)
6049{
6050 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04006051
James Ketrenosafbf30a2005-08-25 00:05:33 -05006052 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06006053 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006054 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
6055 IPW_DL_STATE | IPW_DL_ASSOC,
6056 "Missed beacon: %d - disassociate\n",
6057 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06006058 ipw_remove_current_network(priv);
6059 ipw_disassociate(priv);
6060 return;
6061 }
6062
Jeff Garzikbf794512005-07-31 13:07:26 -04006063 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
Al Viro5b5e8072007-12-27 01:54:06 -05006064 le16_to_cpu(priv->assoc_request.beacon_interval));
James Ketrenos43f66a62005-03-25 12:31:53 -06006065}
6066
David Howellsc4028952006-11-22 14:57:56 +00006067static void ipw_bg_adhoc_check(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006068{
David Howellsc4028952006-11-22 14:57:56 +00006069 struct ipw_priv *priv =
6070 container_of(work, struct ipw_priv, adhoc_check.work);
Zhu Yi46441512006-01-24 16:37:59 +08006071 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006072 ipw_adhoc_check(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006073 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006074}
6075
James Ketrenos43f66a62005-03-25 12:31:53 -06006076static void ipw_debug_config(struct ipw_priv *priv)
6077{
John W. Linville9387b7c2008-09-30 20:59:05 -04006078 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06006079 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
6080 "[CFG 0x%08X]\n", priv->config);
6081 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006082 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06006083 else
6084 IPW_DEBUG_INFO("Channel unlocked.\n");
6085 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04006086 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04006087 print_ssid(ssid, priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06006088 else
6089 IPW_DEBUG_INFO("ESSID unlocked.\n");
6090 if (priv->config & CFG_STATIC_BSSID)
Johannes Berge1749612008-10-27 15:59:26 -07006091 IPW_DEBUG_INFO("BSSID locked to %pM\n", priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06006092 else
6093 IPW_DEBUG_INFO("BSSID unlocked.\n");
6094 if (priv->capability & CAP_PRIVACY_ON)
6095 IPW_DEBUG_INFO("PRIVACY on\n");
6096 else
6097 IPW_DEBUG_INFO("PRIVACY off\n");
6098 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
6099}
James Ketrenos43f66a62005-03-25 12:31:53 -06006100
Arjan van de Ven858119e2006-01-14 13:20:43 -08006101static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06006102{
6103 /* TODO: Verify that this works... */
Reinette Chatre21f8a732009-08-18 10:25:05 -07006104 struct ipw_fixed_rate fr;
James Ketrenos43f66a62005-03-25 12:31:53 -06006105 u32 reg;
6106 u16 mask = 0;
Reinette Chatre21f8a732009-08-18 10:25:05 -07006107 u16 new_tx_rates = priv->rates_mask;
James Ketrenos43f66a62005-03-25 12:31:53 -06006108
Jeff Garzikbf794512005-07-31 13:07:26 -04006109 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06006110 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04006111
James Ketrenos43f66a62005-03-25 12:31:53 -06006112 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006113 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06006114 /* IEEE_A */
6115 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6116 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006117 IPW_DEBUG_WX
6118 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
Reinette Chatre21f8a732009-08-18 10:25:05 -07006119 new_tx_rates = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06006120 break;
6121 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006122
Reinette Chatre21f8a732009-08-18 10:25:05 -07006123 new_tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
James Ketrenos43f66a62005-03-25 12:31:53 -06006124 break;
6125
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006126 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006127 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006128 if (mode == IEEE_B) {
Reinette Chatre21f8a732009-08-18 10:25:05 -07006129 if (new_tx_rates & ~IEEE80211_CCK_RATES_MASK) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006130 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006131 IPW_DEBUG_WX
6132 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
Reinette Chatre21f8a732009-08-18 10:25:05 -07006133 new_tx_rates = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06006134 }
6135 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006136 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006137
6138 /* IEEE_G */
Reinette Chatre21f8a732009-08-18 10:25:05 -07006139 if (new_tx_rates & ~(IEEE80211_CCK_RATES_MASK |
James Ketrenos43f66a62005-03-25 12:31:53 -06006140 IEEE80211_OFDM_RATES_MASK)) {
6141 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006142 IPW_DEBUG_WX
6143 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
Reinette Chatre21f8a732009-08-18 10:25:05 -07006144 new_tx_rates = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06006145 break;
6146 }
6147
Reinette Chatre21f8a732009-08-18 10:25:05 -07006148 if (IEEE80211_OFDM_RATE_6MB_MASK & new_tx_rates) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006149 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
Reinette Chatre21f8a732009-08-18 10:25:05 -07006150 new_tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06006151 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006152
Reinette Chatre21f8a732009-08-18 10:25:05 -07006153 if (IEEE80211_OFDM_RATE_9MB_MASK & new_tx_rates) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006154 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
Reinette Chatre21f8a732009-08-18 10:25:05 -07006155 new_tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06006156 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006157
Reinette Chatre21f8a732009-08-18 10:25:05 -07006158 if (IEEE80211_OFDM_RATE_12MB_MASK & new_tx_rates) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006159 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
Reinette Chatre21f8a732009-08-18 10:25:05 -07006160 new_tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06006161 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006162
Reinette Chatre21f8a732009-08-18 10:25:05 -07006163 new_tx_rates |= mask;
James Ketrenos43f66a62005-03-25 12:31:53 -06006164 break;
6165 }
6166
Reinette Chatre21f8a732009-08-18 10:25:05 -07006167 fr.tx_rates = cpu_to_le16(new_tx_rates);
6168
James Ketrenos43f66a62005-03-25 12:31:53 -06006169 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006170 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006171}
6172
James Ketrenosea2b26e2005-08-24 21:25:16 -05006173static void ipw_abort_scan(struct ipw_priv *priv)
6174{
6175 int err;
6176
6177 if (priv->status & STATUS_SCAN_ABORTING) {
6178 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6179 return;
6180 }
6181 priv->status |= STATUS_SCAN_ABORTING;
6182
6183 err = ipw_send_scan_abort(priv);
6184 if (err)
6185 IPW_DEBUG_HC("Request to abort scan failed.\n");
6186}
6187
James Ketrenosafbf30a2005-08-25 00:05:33 -05006188static void ipw_add_scan_channels(struct ipw_priv *priv,
6189 struct ipw_scan_request_ext *scan,
6190 int scan_type)
6191{
6192 int channel_index = 0;
6193 const struct ieee80211_geo *geo;
6194 int i;
6195
Larry Finger1867b112006-02-28 09:48:28 -06006196 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006197
6198 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6199 int start = channel_index;
6200 for (i = 0; i < geo->a_channels; i++) {
6201 if ((priv->status & STATUS_ASSOCIATED) &&
6202 geo->a[i].channel == priv->channel)
6203 continue;
6204 channel_index++;
6205 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006206 ipw_set_scan_type(scan, channel_index,
6207 geo->a[i].
6208 flags & IEEE80211_CH_PASSIVE_ONLY ?
6209 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6210 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006211 }
6212
6213 if (start != channel_index) {
6214 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6215 (channel_index - start);
6216 channel_index++;
6217 }
6218 }
6219
6220 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6221 int start = channel_index;
6222 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006223 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006224 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6225 /* nop out the list */
6226 [0] = 0
6227 };
6228
6229 u8 channel;
Zhu Yi7dd24592009-07-27 10:10:20 +08006230 while (channel_index < IPW_SCAN_CHANNELS - 1) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006231 channel =
6232 priv->speed_scan[priv->speed_scan_pos];
6233 if (channel == 0) {
6234 priv->speed_scan_pos = 0;
6235 channel = priv->speed_scan[0];
6236 }
6237 if ((priv->status & STATUS_ASSOCIATED) &&
6238 channel == priv->channel) {
6239 priv->speed_scan_pos++;
6240 continue;
6241 }
6242
6243 /* If this channel has already been
6244 * added in scan, break from loop
6245 * and this will be the first channel
6246 * in the next scan.
6247 */
6248 if (channels[channel - 1] != 0)
6249 break;
6250
6251 channels[channel - 1] = 1;
6252 priv->speed_scan_pos++;
6253 channel_index++;
6254 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006255 index =
Larry Finger1867b112006-02-28 09:48:28 -06006256 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006257 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006258 geo->bg[index].
6259 flags &
6260 IEEE80211_CH_PASSIVE_ONLY ?
6261 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6262 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006263 }
6264 } else {
6265 for (i = 0; i < geo->bg_channels; i++) {
6266 if ((priv->status & STATUS_ASSOCIATED) &&
6267 geo->bg[i].channel == priv->channel)
6268 continue;
6269 channel_index++;
6270 scan->channels_list[channel_index] =
6271 geo->bg[i].channel;
6272 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006273 geo->bg[i].
6274 flags &
6275 IEEE80211_CH_PASSIVE_ONLY ?
6276 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6277 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006278 }
6279 }
6280
6281 if (start != channel_index) {
6282 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6283 (channel_index - start);
6284 }
6285 }
6286}
6287
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006288static int ipw_passive_dwell_time(struct ipw_priv *priv)
6289{
6290 /* staying on passive channels longer than the DTIM interval during a
6291 * scan, while associated, causes the firmware to cancel the scan
6292 * without notification. Hence, don't stay on passive channels longer
6293 * than the beacon interval.
6294 */
6295 if (priv->status & STATUS_ASSOCIATED
6296 && priv->assoc_network->beacon_interval > 10)
6297 return priv->assoc_network->beacon_interval - 10;
6298 else
6299 return 120;
6300}
6301
Dan Williamsea177302008-06-02 17:51:23 -04006302static int ipw_request_scan_helper(struct ipw_priv *priv, int type, int direct)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006303{
6304 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006305 int err = 0, scan_type;
6306
6307 if (!(priv->status & STATUS_INIT) ||
6308 (priv->status & STATUS_EXIT_PENDING))
6309 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006310
Zhu Yi46441512006-01-24 16:37:59 +08006311 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006312
Dan Williamsea177302008-06-02 17:51:23 -04006313 if (direct && (priv->direct_scan_ssid_len == 0)) {
6314 IPW_DEBUG_HC("Direct scan requested but no SSID to scan for\n");
6315 priv->status &= ~STATUS_DIRECT_SCAN_PENDING;
6316 goto done;
6317 }
6318
James Ketrenosea2b26e2005-08-24 21:25:16 -05006319 if (priv->status & STATUS_SCANNING) {
Dan Williamsea177302008-06-02 17:51:23 -04006320 IPW_DEBUG_HC("Concurrent scan requested. Queuing.\n");
6321 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6322 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006323 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006324 }
6325
James Ketrenosafbf30a2005-08-25 00:05:33 -05006326 if (!(priv->status & STATUS_SCAN_FORCED) &&
6327 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006328 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
Dan Williamsea177302008-06-02 17:51:23 -04006329 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6330 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006331 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006332 }
6333
6334 if (priv->status & STATUS_RF_KILL_MASK) {
Dan Williamsea177302008-06-02 17:51:23 -04006335 IPW_DEBUG_HC("Queuing scan due to RF Kill activation\n");
6336 priv->status |= direct ? STATUS_DIRECT_SCAN_PENDING :
6337 STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006338 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006339 }
6340
6341 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006342 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006343
Zhu Yi094c4d22006-08-21 11:39:03 +08006344 if (type == IW_SCAN_TYPE_PASSIVE) {
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006345 IPW_DEBUG_WX("use passive scanning\n");
6346 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
Zhu Yi094c4d22006-08-21 11:39:03 +08006347 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006348 cpu_to_le16(ipw_passive_dwell_time(priv));
Zhu Yi094c4d22006-08-21 11:39:03 +08006349 ipw_add_scan_channels(priv, &scan, scan_type);
6350 goto send_request;
6351 }
6352
6353 /* Use active scan by default. */
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006354 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006355 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006356 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006357 else
6358 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006359 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006360
James Ketrenosa613bff2005-08-24 21:43:11 -05006361 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006362 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006363
Helmut Schaa14a4dfe2008-12-10 13:17:26 +01006364 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6365 cpu_to_le16(ipw_passive_dwell_time(priv));
Dan Williamsea177302008-06-02 17:51:23 -04006366 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006367
James Ketrenosb095c382005-08-24 22:04:42 -05006368#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006369 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006370 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006371 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006372
Larry Finger1867b112006-02-28 09:48:28 -06006373 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006374 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006375 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006376 channel = priv->channel;
6377 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006378
James Ketrenosb095c382005-08-24 22:04:42 -05006379 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006380 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006381 channel = priv->channel;
6382 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006383
James Ketrenosb095c382005-08-24 22:04:42 -05006384 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006385 band = (u8) (IPW_B_MODE << 6) | 1;
6386 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006387 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006388 }
6389
James Ketrenosb095c382005-08-24 22:04:42 -05006390 scan.channels_list[0] = band;
6391 scan.channels_list[1] = channel;
6392 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006393
James Ketrenosb095c382005-08-24 22:04:42 -05006394 /* NOTE: The card will sit on this channel for this time
6395 * period. Scan aborts are timing sensitive and frequently
6396 * result in firmware restarts. As such, it is best to
6397 * set a small dwell_time here and just keep re-issuing
6398 * scans. Otherwise fast channel hopping will not actually
6399 * hop channels.
6400 *
6401 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006402 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006403 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006404 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006405#endif /* CONFIG_IPW2200_MONITOR */
Dan Williamsea177302008-06-02 17:51:23 -04006406 /* Honor direct scans first, otherwise if we are roaming make
6407 * this a direct scan for the current network. Finally,
6408 * ensure that every other scan is a fast channel hop scan */
6409 if (direct) {
6410 err = ipw_send_ssid(priv, priv->direct_scan_ssid,
6411 priv->direct_scan_ssid_len);
6412 if (err) {
6413 IPW_DEBUG_HC("Attempt to send SSID command "
6414 "failed\n");
6415 goto done;
6416 }
6417
6418 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
6419 } else if ((priv->status & STATUS_ROAMING)
6420 || (!(priv->status & STATUS_ASSOCIATED)
6421 && (priv->config & CFG_STATIC_ESSID)
6422 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006423 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6424 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006425 IPW_DEBUG_HC("Attempt to send SSID command "
6426 "failed.\n");
6427 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006428 }
6429
6430 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006431 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006432 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006433
James Ketrenosafbf30a2005-08-25 00:05:33 -05006434 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006435#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006436 }
6437#endif
6438
Zhu Yi094c4d22006-08-21 11:39:03 +08006439send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006440 err = ipw_send_scan_request_ext(priv, &scan);
6441 if (err) {
6442 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006443 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006444 }
6445
6446 priv->status |= STATUS_SCANNING;
Dan Williamsea177302008-06-02 17:51:23 -04006447 if (direct) {
6448 priv->status &= ~STATUS_DIRECT_SCAN_PENDING;
6449 priv->direct_scan_ssid_len = 0;
6450 } else
6451 priv->status &= ~STATUS_SCAN_PENDING;
6452
James Ketrenosafbf30a2005-08-25 00:05:33 -05006453 queue_delayed_work(priv->workqueue, &priv->scan_check,
6454 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006455done:
Zhu Yi46441512006-01-24 16:37:59 +08006456 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006457 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006458}
6459
David Howellsc4028952006-11-22 14:57:56 +00006460static void ipw_request_passive_scan(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05006461{
David Howellsc4028952006-11-22 14:57:56 +00006462 struct ipw_priv *priv =
Dan Williamsea177302008-06-02 17:51:23 -04006463 container_of(work, struct ipw_priv, request_passive_scan.work);
6464 ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE, 0);
David Howellsc4028952006-11-22 14:57:56 +00006465}
6466
6467static void ipw_request_scan(struct work_struct *work)
6468{
6469 struct ipw_priv *priv =
6470 container_of(work, struct ipw_priv, request_scan.work);
Dan Williamsea177302008-06-02 17:51:23 -04006471 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE, 0);
6472}
6473
6474static void ipw_request_direct_scan(struct work_struct *work)
6475{
6476 struct ipw_priv *priv =
6477 container_of(work, struct ipw_priv, request_direct_scan.work);
6478 ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE, 1);
David Howellsc4028952006-11-22 14:57:56 +00006479}
6480
6481static void ipw_bg_abort_scan(struct work_struct *work)
6482{
6483 struct ipw_priv *priv =
6484 container_of(work, struct ipw_priv, abort_scan);
Zhu Yi46441512006-01-24 16:37:59 +08006485 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00006486 ipw_abort_scan(priv);
Zhu Yi46441512006-01-24 16:37:59 +08006487 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006488}
6489
James Ketrenosea2b26e2005-08-24 21:25:16 -05006490static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6491{
James Ketrenosb095c382005-08-24 22:04:42 -05006492 /* This is called when wpa_supplicant loads and closes the driver
6493 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006494 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006495 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006496}
6497
James Ketrenosea2b26e2005-08-24 21:25:16 -05006498static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6499{
6500 struct ieee80211_device *ieee = priv->ieee;
6501 struct ieee80211_security sec = {
6502 .flags = SEC_AUTH_MODE,
6503 };
6504 int ret = 0;
6505
James Ketrenosafbf30a2005-08-25 00:05:33 -05006506 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006507 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6508 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006509 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006510 sec.auth_mode = WLAN_AUTH_OPEN;
6511 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006512 } else if (value & IW_AUTH_ALG_LEAP) {
6513 sec.auth_mode = WLAN_AUTH_LEAP;
6514 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006515 } else
6516 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006517
6518 if (ieee->set_security)
6519 ieee->set_security(ieee->dev, &sec);
6520 else
6521 ret = -EOPNOTSUPP;
6522
6523 return ret;
6524}
6525
Adrian Bunka73e22b2006-01-21 01:39:42 +01006526static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6527 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006528{
6529 /* make sure WPA is enabled */
6530 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006531}
6532
6533static int ipw_set_rsn_capa(struct ipw_priv *priv,
6534 char *capabilities, int length)
6535{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006536 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6537
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006538 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006539 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006540}
6541
James Ketrenosafbf30a2005-08-25 00:05:33 -05006542/*
6543 * WE-18 support
6544 */
6545
6546/* SIOCSIWGENIE */
6547static int ipw_wx_set_genie(struct net_device *dev,
6548 struct iw_request_info *info,
6549 union iwreq_data *wrqu, char *extra)
6550{
6551 struct ipw_priv *priv = ieee80211_priv(dev);
6552 struct ieee80211_device *ieee = priv->ieee;
6553 u8 *buf;
6554 int err = 0;
6555
6556 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6557 (wrqu->data.length && extra == NULL))
6558 return -EINVAL;
6559
James Ketrenosafbf30a2005-08-25 00:05:33 -05006560 if (wrqu->data.length) {
6561 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6562 if (buf == NULL) {
6563 err = -ENOMEM;
6564 goto out;
6565 }
6566
6567 memcpy(buf, extra, wrqu->data.length);
6568 kfree(ieee->wpa_ie);
6569 ieee->wpa_ie = buf;
6570 ieee->wpa_ie_len = wrqu->data.length;
6571 } else {
6572 kfree(ieee->wpa_ie);
6573 ieee->wpa_ie = NULL;
6574 ieee->wpa_ie_len = 0;
6575 }
6576
6577 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6578 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006579 return err;
6580}
6581
6582/* SIOCGIWGENIE */
6583static int ipw_wx_get_genie(struct net_device *dev,
6584 struct iw_request_info *info,
6585 union iwreq_data *wrqu, char *extra)
6586{
6587 struct ipw_priv *priv = ieee80211_priv(dev);
6588 struct ieee80211_device *ieee = priv->ieee;
6589 int err = 0;
6590
James Ketrenosafbf30a2005-08-25 00:05:33 -05006591 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6592 wrqu->data.length = 0;
6593 goto out;
6594 }
6595
6596 if (wrqu->data.length < ieee->wpa_ie_len) {
6597 err = -E2BIG;
6598 goto out;
6599 }
6600
6601 wrqu->data.length = ieee->wpa_ie_len;
6602 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6603
6604 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006605 return err;
6606}
6607
Zhu Yi1fbfea52005-08-05 17:22:56 +08006608static int wext_cipher2level(int cipher)
6609{
6610 switch (cipher) {
6611 case IW_AUTH_CIPHER_NONE:
6612 return SEC_LEVEL_0;
6613 case IW_AUTH_CIPHER_WEP40:
6614 case IW_AUTH_CIPHER_WEP104:
6615 return SEC_LEVEL_1;
6616 case IW_AUTH_CIPHER_TKIP:
6617 return SEC_LEVEL_2;
6618 case IW_AUTH_CIPHER_CCMP:
6619 return SEC_LEVEL_3;
6620 default:
6621 return -1;
6622 }
6623}
6624
James Ketrenosafbf30a2005-08-25 00:05:33 -05006625/* SIOCSIWAUTH */
6626static int ipw_wx_set_auth(struct net_device *dev,
6627 struct iw_request_info *info,
6628 union iwreq_data *wrqu, char *extra)
6629{
6630 struct ipw_priv *priv = ieee80211_priv(dev);
6631 struct ieee80211_device *ieee = priv->ieee;
6632 struct iw_param *param = &wrqu->param;
John W. Linville274bfb82008-10-29 11:35:05 -04006633 struct lib80211_crypt_data *crypt;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006634 unsigned long flags;
6635 int ret = 0;
6636
6637 switch (param->flags & IW_AUTH_INDEX) {
6638 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006639 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006640 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006641 ipw_set_hw_decrypt_unicast(priv,
6642 wext_cipher2level(param->value));
6643 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006644 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006645 ipw_set_hw_decrypt_multicast(priv,
6646 wext_cipher2level(param->value));
6647 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006648 case IW_AUTH_KEY_MGMT:
6649 /*
6650 * ipw2200 does not use these parameters
6651 */
6652 break;
6653
6654 case IW_AUTH_TKIP_COUNTERMEASURES:
John W. Linville274bfb82008-10-29 11:35:05 -04006655 crypt = priv->ieee->crypt_info.crypt[priv->ieee->crypt_info.tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006656 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006657 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006658
6659 flags = crypt->ops->get_flags(crypt->priv);
6660
6661 if (param->value)
6662 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6663 else
6664 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6665
6666 crypt->ops->set_flags(flags, crypt->priv);
6667
6668 break;
6669
6670 case IW_AUTH_DROP_UNENCRYPTED:{
6671 /* HACK:
6672 *
6673 * wpa_supplicant calls set_wpa_enabled when the driver
6674 * is loaded and unloaded, regardless of if WPA is being
6675 * used. No other calls are made which can be used to
6676 * determine if encryption will be used or not prior to
6677 * association being expected. If encryption is not being
6678 * used, drop_unencrypted is set to false, else true -- we
6679 * can use this to determine if the CAP_PRIVACY_ON bit should
6680 * be set.
6681 */
6682 struct ieee80211_security sec = {
6683 .flags = SEC_ENABLED,
6684 .enabled = param->value,
6685 };
6686 priv->ieee->drop_unencrypted = param->value;
6687 /* We only change SEC_LEVEL for open mode. Others
6688 * are set by ipw_wpa_set_encryption.
6689 */
6690 if (!param->value) {
6691 sec.flags |= SEC_LEVEL;
6692 sec.level = SEC_LEVEL_0;
6693 } else {
6694 sec.flags |= SEC_LEVEL;
6695 sec.level = SEC_LEVEL_1;
6696 }
6697 if (priv->ieee->set_security)
6698 priv->ieee->set_security(priv->ieee->dev, &sec);
6699 break;
6700 }
6701
6702 case IW_AUTH_80211_AUTH_ALG:
6703 ret = ipw_wpa_set_auth_algs(priv, param->value);
6704 break;
6705
6706 case IW_AUTH_WPA_ENABLED:
6707 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006708 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006709 break;
6710
6711 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6712 ieee->ieee802_1x = param->value;
6713 break;
6714
James Ketrenosafbf30a2005-08-25 00:05:33 -05006715 case IW_AUTH_PRIVACY_INVOKED:
6716 ieee->privacy_invoked = param->value;
6717 break;
6718
6719 default:
6720 return -EOPNOTSUPP;
6721 }
6722 return ret;
6723}
6724
6725/* SIOCGIWAUTH */
6726static int ipw_wx_get_auth(struct net_device *dev,
6727 struct iw_request_info *info,
6728 union iwreq_data *wrqu, char *extra)
6729{
6730 struct ipw_priv *priv = ieee80211_priv(dev);
6731 struct ieee80211_device *ieee = priv->ieee;
John W. Linville274bfb82008-10-29 11:35:05 -04006732 struct lib80211_crypt_data *crypt;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006733 struct iw_param *param = &wrqu->param;
6734 int ret = 0;
6735
6736 switch (param->flags & IW_AUTH_INDEX) {
6737 case IW_AUTH_WPA_VERSION:
6738 case IW_AUTH_CIPHER_PAIRWISE:
6739 case IW_AUTH_CIPHER_GROUP:
6740 case IW_AUTH_KEY_MGMT:
6741 /*
6742 * wpa_supplicant will control these internally
6743 */
6744 ret = -EOPNOTSUPP;
6745 break;
6746
6747 case IW_AUTH_TKIP_COUNTERMEASURES:
John W. Linville274bfb82008-10-29 11:35:05 -04006748 crypt = priv->ieee->crypt_info.crypt[priv->ieee->crypt_info.tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006749 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006750 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006751
6752 param->value = (crypt->ops->get_flags(crypt->priv) &
6753 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6754
6755 break;
6756
6757 case IW_AUTH_DROP_UNENCRYPTED:
6758 param->value = ieee->drop_unencrypted;
6759 break;
6760
6761 case IW_AUTH_80211_AUTH_ALG:
6762 param->value = ieee->sec.auth_mode;
6763 break;
6764
6765 case IW_AUTH_WPA_ENABLED:
6766 param->value = ieee->wpa_enabled;
6767 break;
6768
6769 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6770 param->value = ieee->ieee802_1x;
6771 break;
6772
6773 case IW_AUTH_ROAMING_CONTROL:
6774 case IW_AUTH_PRIVACY_INVOKED:
6775 param->value = ieee->privacy_invoked;
6776 break;
6777
6778 default:
6779 return -EOPNOTSUPP;
6780 }
6781 return 0;
6782}
6783
6784/* SIOCSIWENCODEEXT */
6785static int ipw_wx_set_encodeext(struct net_device *dev,
6786 struct iw_request_info *info,
6787 union iwreq_data *wrqu, char *extra)
6788{
6789 struct ipw_priv *priv = ieee80211_priv(dev);
6790 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6791
6792 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006793 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006794 /* IPW HW can't build TKIP MIC,
6795 host decryption still needed */
6796 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6797 priv->ieee->host_mc_decrypt = 1;
6798 else {
6799 priv->ieee->host_encrypt = 0;
6800 priv->ieee->host_encrypt_msdu = 1;
6801 priv->ieee->host_decrypt = 1;
6802 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006803 } else {
6804 priv->ieee->host_encrypt = 0;
6805 priv->ieee->host_encrypt_msdu = 0;
6806 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006807 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006808 }
6809 }
6810
6811 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6812}
6813
6814/* SIOCGIWENCODEEXT */
6815static int ipw_wx_get_encodeext(struct net_device *dev,
6816 struct iw_request_info *info,
6817 union iwreq_data *wrqu, char *extra)
6818{
6819 struct ipw_priv *priv = ieee80211_priv(dev);
6820 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6821}
6822
6823/* SIOCSIWMLME */
6824static int ipw_wx_set_mlme(struct net_device *dev,
6825 struct iw_request_info *info,
6826 union iwreq_data *wrqu, char *extra)
6827{
6828 struct ipw_priv *priv = ieee80211_priv(dev);
6829 struct iw_mlme *mlme = (struct iw_mlme *)extra;
Al Viroe62e1ee2007-12-27 01:36:46 -05006830 __le16 reason;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006831
6832 reason = cpu_to_le16(mlme->reason_code);
6833
6834 switch (mlme->cmd) {
6835 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006836 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006837 break;
6838
6839 case IW_MLME_DISASSOC:
6840 ipw_disassociate(priv);
6841 break;
6842
6843 default:
6844 return -EOPNOTSUPP;
6845 }
6846 return 0;
6847}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006848
Zhu Yie43e3c12006-04-13 17:20:45 +08006849#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006850
6851/* QoS */
6852/*
6853* get the modulation type of the current network or
6854* the card current mode
6855*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006856static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006857{
6858 u8 mode = 0;
6859
6860 if (priv->status & STATUS_ASSOCIATED) {
6861 unsigned long flags;
6862
6863 spin_lock_irqsave(&priv->ieee->lock, flags);
6864 mode = priv->assoc_network->mode;
6865 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6866 } else {
6867 mode = priv->ieee->mode;
6868 }
6869 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6870 return mode;
6871}
6872
6873/*
6874* Handle management frame beacon and probe response
6875*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006876static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6877 int active_network,
6878 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006879{
6880 u32 size = sizeof(struct ieee80211_qos_parameters);
6881
James Ketrenosafbf30a2005-08-25 00:05:33 -05006882 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006883 network->qos_data.active = network->qos_data.supported;
6884
6885 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006886 if (active_network &&
6887 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006888 network->qos_data.active = network->qos_data.supported;
6889
6890 if ((network->qos_data.active == 1) && (active_network == 1) &&
6891 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6892 (network->qos_data.old_param_count !=
6893 network->qos_data.param_count)) {
6894 network->qos_data.old_param_count =
6895 network->qos_data.param_count;
6896 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006897 IPW_DEBUG_QOS("QoS parameters change call "
6898 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006899 }
6900 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006901 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6902 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006903 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006904 else
6905 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006906 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006907
James Ketrenosb095c382005-08-24 22:04:42 -05006908 if ((network->qos_data.active == 1) && (active_network == 1)) {
6909 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6910 schedule_work(&priv->qos_activate);
6911 }
6912
6913 network->qos_data.active = 0;
6914 network->qos_data.supported = 0;
6915 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006916 if ((priv->status & STATUS_ASSOCIATED) &&
6917 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6918 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
John W. Linvillec5d3dce2008-09-30 17:17:26 -04006919 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006920 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006921 priv->assoc_network->ssid_len) &&
6922 !memcmp(network->ssid,
6923 priv->assoc_network->ssid,
6924 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006925 queue_work(priv->workqueue,
6926 &priv->merge_networks);
6927 }
James Ketrenosb095c382005-08-24 22:04:42 -05006928 }
6929
6930 return 0;
6931}
6932
6933/*
6934* This function set up the firmware to support QoS. It sends
6935* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6936*/
6937static int ipw_qos_activate(struct ipw_priv *priv,
6938 struct ieee80211_qos_data *qos_network_data)
6939{
6940 int err;
6941 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6942 struct ieee80211_qos_parameters *active_one = NULL;
6943 u32 size = sizeof(struct ieee80211_qos_parameters);
6944 u32 burst_duration;
6945 int i;
6946 u8 type;
6947
6948 type = ipw_qos_current_mode(priv);
6949
6950 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6951 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6952 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6953 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6954
6955 if (qos_network_data == NULL) {
6956 if (type == IEEE_B) {
6957 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6958 active_one = &def_parameters_CCK;
6959 } else
6960 active_one = &def_parameters_OFDM;
6961
James Ketrenosafbf30a2005-08-25 00:05:33 -05006962 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006963 burst_duration = ipw_qos_get_burst_duration(priv);
6964 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006965 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Al Viro8fffc152007-12-27 01:25:40 -05006966 cpu_to_le16(burst_duration);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006967 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006968 if (type == IEEE_B) {
6969 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6970 type);
6971 if (priv->qos_data.qos_enable == 0)
6972 active_one = &def_parameters_CCK;
6973 else
6974 active_one = priv->qos_data.def_qos_parm_CCK;
6975 } else {
6976 if (priv->qos_data.qos_enable == 0)
6977 active_one = &def_parameters_OFDM;
6978 else
6979 active_one = priv->qos_data.def_qos_parm_OFDM;
6980 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006981 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006982 } else {
6983 unsigned long flags;
6984 int active;
6985
6986 spin_lock_irqsave(&priv->ieee->lock, flags);
6987 active_one = &(qos_network_data->parameters);
6988 qos_network_data->old_param_count =
6989 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006990 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006991 active = qos_network_data->supported;
6992 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6993
6994 if (active == 0) {
6995 burst_duration = ipw_qos_get_burst_duration(priv);
6996 for (i = 0; i < QOS_QUEUE_NUM; i++)
6997 qos_parameters[QOS_PARAM_SET_ACTIVE].
Al Viro8fffc152007-12-27 01:25:40 -05006998 tx_op_limit[i] = cpu_to_le16(burst_duration);
James Ketrenosb095c382005-08-24 22:04:42 -05006999 }
7000 }
7001
7002 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05007003 err = ipw_send_qos_params_command(priv,
7004 (struct ieee80211_qos_parameters *)
7005 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05007006 if (err)
7007 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
7008
7009 return err;
7010}
7011
7012/*
7013* send IPW_CMD_WME_INFO to the firmware
7014*/
7015static int ipw_qos_set_info_element(struct ipw_priv *priv)
7016{
7017 int ret = 0;
7018 struct ieee80211_qos_information_element qos_info;
7019
7020 if (priv == NULL)
7021 return -1;
7022
7023 qos_info.elementID = QOS_ELEMENT_ID;
7024 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
7025
7026 qos_info.version = QOS_VERSION_1;
7027 qos_info.ac_info = 0;
7028
7029 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
7030 qos_info.qui_type = QOS_OUI_TYPE;
7031 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
7032
7033 ret = ipw_send_qos_info_command(priv, &qos_info);
7034 if (ret != 0) {
7035 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
7036 }
7037 return ret;
7038}
7039
7040/*
7041* Set the QoS parameter with the association request structure
7042*/
7043static int ipw_qos_association(struct ipw_priv *priv,
7044 struct ieee80211_network *network)
7045{
7046 int err = 0;
7047 struct ieee80211_qos_data *qos_data = NULL;
7048 struct ieee80211_qos_data ibss_data = {
7049 .supported = 1,
7050 .active = 1,
7051 };
7052
7053 switch (priv->ieee->iw_mode) {
7054 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02007055 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05007056
7057 qos_data = &ibss_data;
7058 break;
7059
7060 case IW_MODE_INFRA:
7061 qos_data = &network->qos_data;
7062 break;
7063
7064 default:
7065 BUG();
7066 break;
7067 }
7068
7069 err = ipw_qos_activate(priv, qos_data);
7070 if (err) {
7071 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
7072 return err;
7073 }
7074
7075 if (priv->qos_data.qos_enable && qos_data->supported) {
7076 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
7077 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
7078 return ipw_qos_set_info_element(priv);
7079 }
7080
7081 return 0;
7082}
7083
7084/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01007085* handling the beaconing responses. if we get different QoS setting
7086* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05007087* setting
7088*/
7089static int ipw_qos_association_resp(struct ipw_priv *priv,
7090 struct ieee80211_network *network)
7091{
7092 int ret = 0;
7093 unsigned long flags;
7094 u32 size = sizeof(struct ieee80211_qos_parameters);
7095 int set_qos_param = 0;
7096
James Ketrenosafbf30a2005-08-25 00:05:33 -05007097 if ((priv == NULL) || (network == NULL) ||
7098 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05007099 return ret;
7100
7101 if (!(priv->status & STATUS_ASSOCIATED))
7102 return ret;
7103
James Ketrenosafbf30a2005-08-25 00:05:33 -05007104 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05007105 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05007106
7107 spin_lock_irqsave(&priv->ieee->lock, flags);
7108 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007109 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05007110 sizeof(struct ieee80211_qos_data));
7111 priv->assoc_network->qos_data.active = 1;
7112 if ((network->qos_data.old_param_count !=
7113 network->qos_data.param_count)) {
7114 set_qos_param = 1;
7115 network->qos_data.old_param_count =
7116 network->qos_data.param_count;
7117 }
7118
7119 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007120 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
7121 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007122 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007123 else
7124 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05007125 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05007126 priv->assoc_network->qos_data.active = 0;
7127 priv->assoc_network->qos_data.supported = 0;
7128 set_qos_param = 1;
7129 }
7130
7131 spin_unlock_irqrestore(&priv->ieee->lock, flags);
7132
7133 if (set_qos_param == 1)
7134 schedule_work(&priv->qos_activate);
7135
7136 return ret;
7137}
7138
7139static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
7140{
7141 u32 ret = 0;
7142
7143 if ((priv == NULL))
7144 return 0;
7145
James Ketrenosafbf30a2005-08-25 00:05:33 -05007146 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05007147 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007148 else
James Ketrenosb095c382005-08-24 22:04:42 -05007149 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007150
James Ketrenosb095c382005-08-24 22:04:42 -05007151 return ret;
7152}
7153
7154/*
7155* Initialize the setting of QoS global
7156*/
7157static void ipw_qos_init(struct ipw_priv *priv, int enable,
7158 int burst_enable, u32 burst_duration_CCK,
7159 u32 burst_duration_OFDM)
7160{
7161 priv->qos_data.qos_enable = enable;
7162
7163 if (priv->qos_data.qos_enable) {
7164 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7165 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7166 IPW_DEBUG_QOS("QoS is enabled\n");
7167 } else {
7168 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7169 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7170 IPW_DEBUG_QOS("QoS is not enabled\n");
7171 }
7172
7173 priv->qos_data.burst_enable = burst_enable;
7174
7175 if (burst_enable) {
7176 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7177 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7178 } else {
7179 priv->qos_data.burst_duration_CCK = 0;
7180 priv->qos_data.burst_duration_OFDM = 0;
7181 }
7182}
7183
7184/*
7185* map the packet priority to the right TX Queue
7186*/
7187static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7188{
7189 if (priority > 7 || !priv->qos_data.qos_enable)
7190 priority = 0;
7191
7192 return from_priority_to_tx_queue[priority] - 1;
7193}
7194
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007195static int ipw_is_qos_active(struct net_device *dev,
7196 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007197{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007198 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007199 struct ieee80211_qos_data *qos_data = NULL;
7200 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007201 u8 *daddr = skb->data + ETH_ALEN;
7202 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007203
7204 if (!(priv->status & STATUS_ASSOCIATED))
7205 return 0;
7206
7207 qos_data = &priv->assoc_network->qos_data;
7208
James Ketrenosb095c382005-08-24 22:04:42 -05007209 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7210 if (unicast == 0)
7211 qos_data->active = 0;
7212 else
7213 qos_data->active = qos_data->supported;
7214 }
James Ketrenosb095c382005-08-24 22:04:42 -05007215 active = qos_data->active;
7216 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007217 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7218 "unicast %d\n",
7219 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007220 if (active && priv->qos_data.qos_enable)
7221 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007222
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007223 return 0;
7224
7225}
7226/*
7227* add QoS parameter to the TX command
7228*/
7229static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7230 u16 priority,
7231 struct tfd_data *tfd)
7232{
7233 int tx_queue_id = 0;
7234
7235
7236 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7237 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7238
7239 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7240 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007241 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007242 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007243 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007244}
7245
7246/*
7247* background support to run QoS activate functionality
7248*/
David Howellsc4028952006-11-22 14:57:56 +00007249static void ipw_bg_qos_activate(struct work_struct *work)
James Ketrenosb095c382005-08-24 22:04:42 -05007250{
David Howellsc4028952006-11-22 14:57:56 +00007251 struct ipw_priv *priv =
7252 container_of(work, struct ipw_priv, qos_activate);
James Ketrenosb095c382005-08-24 22:04:42 -05007253
Zhu Yi46441512006-01-24 16:37:59 +08007254 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007255
7256 if (priv->status & STATUS_ASSOCIATED)
7257 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7258
Zhu Yi46441512006-01-24 16:37:59 +08007259 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007260}
7261
James Ketrenos3b9990c2005-08-19 13:18:55 -05007262static int ipw_handle_probe_response(struct net_device *dev,
7263 struct ieee80211_probe_response *resp,
7264 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007265{
7266 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007267 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7268 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007269
James Ketrenos3b9990c2005-08-19 13:18:55 -05007270 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007271
James Ketrenos3b9990c2005-08-19 13:18:55 -05007272 return 0;
7273}
James Ketrenosb095c382005-08-24 22:04:42 -05007274
James Ketrenos3b9990c2005-08-19 13:18:55 -05007275static int ipw_handle_beacon(struct net_device *dev,
7276 struct ieee80211_beacon *resp,
7277 struct ieee80211_network *network)
7278{
7279 struct ipw_priv *priv = ieee80211_priv(dev);
7280 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7281 (network == priv->assoc_network));
7282
7283 ipw_qos_handle_probe_response(priv, active_network, network);
7284
7285 return 0;
7286}
7287
7288static int ipw_handle_assoc_response(struct net_device *dev,
7289 struct ieee80211_assoc_response *resp,
7290 struct ieee80211_network *network)
7291{
7292 struct ipw_priv *priv = ieee80211_priv(dev);
7293 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007294 return 0;
7295}
7296
7297static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7298 *qos_param)
7299{
Zhu Yi4e226992006-01-24 16:37:36 +08007300 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7301 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007302}
7303
7304static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7305 *qos_param)
7306{
Zhu Yi4e226992006-01-24 16:37:36 +08007307 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7308 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007309}
7310
Zhu Yie43e3c12006-04-13 17:20:45 +08007311#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007312
James Ketrenos43f66a62005-03-25 12:31:53 -06007313static int ipw_associate_network(struct ipw_priv *priv,
7314 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007315 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007316{
7317 int err;
John W. Linville9387b7c2008-09-30 20:59:05 -04007318 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007319
7320 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007321 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007322
7323 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007324 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007325 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007326 memcpy(priv->essid, network->ssid, priv->essid_len);
7327 }
7328
7329 network->last_associate = jiffies;
7330
7331 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7332 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007333 priv->assoc_request.auth_key = 0;
7334
James Ketrenos43f66a62005-03-25 12:31:53 -06007335 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007336 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007337 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007338 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7339
Zhu Yi1ba61e02006-02-15 13:00:55 +08007340 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007341 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007342
7343 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7344 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7345 priv->assoc_request.auth_type = AUTH_LEAP;
7346 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007347 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007348
James Ketrenosa613bff2005-08-24 21:43:11 -05007349 if (priv->ieee->wpa_ie_len) {
Al Viro5b5e8072007-12-27 01:54:06 -05007350 priv->assoc_request.policy_support = cpu_to_le16(0x02); /* RSN active */
James Ketrenosea2b26e2005-08-24 21:25:16 -05007351 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7352 priv->ieee->wpa_ie_len);
7353 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007354
Jeff Garzikbf794512005-07-31 13:07:26 -04007355 /*
7356 * It is valid for our ieee device to support multiple modes, but
7357 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007358 * just one mode.
7359 */
7360 if (network->mode & priv->ieee->mode & IEEE_A)
7361 priv->assoc_request.ieee_mode = IPW_A_MODE;
7362 else if (network->mode & priv->ieee->mode & IEEE_G)
7363 priv->assoc_request.ieee_mode = IPW_G_MODE;
7364 else if (network->mode & priv->ieee->mode & IEEE_B)
7365 priv->assoc_request.ieee_mode = IPW_B_MODE;
7366
Al Viro5b5e8072007-12-27 01:54:06 -05007367 priv->assoc_request.capability = cpu_to_le16(network->capability);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007368 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7369 && !(priv->config & CFG_PREAMBLE_LONG)) {
7370 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7371 } else {
7372 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7373
7374 /* Clear the short preamble if we won't be supporting it */
7375 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007376 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_PREAMBLE);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007377 }
7378
James Ketrenosafbf30a2005-08-25 00:05:33 -05007379 /* Clear capability bits that aren't used in Ad Hoc */
7380 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7381 priv->assoc_request.capability &=
Al Viro5b5e8072007-12-27 01:54:06 -05007382 ~cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME);
James Ketrenosafbf30a2005-08-25 00:05:33 -05007383
James Ketrenos43f66a62005-03-25 12:31:53 -06007384 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007385 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007386 roaming ? "Rea" : "A",
John W. Linville9387b7c2008-09-30 20:59:05 -04007387 print_ssid(ssid, priv->essid, priv->essid_len),
Jeff Garzikbf794512005-07-31 13:07:26 -04007388 network->channel,
7389 ipw_modes[priv->assoc_request.ieee_mode],
7390 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007391 (priv->assoc_request.preamble_length ==
7392 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7393 network->capability &
7394 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007395 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007396 priv->capability & CAP_PRIVACY_ON ?
7397 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007398 "(open)") : "",
7399 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007400 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007401 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007402 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007403
Al Viro5b5e8072007-12-27 01:54:06 -05007404 priv->assoc_request.beacon_interval = cpu_to_le16(network->beacon_interval);
James Ketrenos43f66a62005-03-25 12:31:53 -06007405 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007406 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007407 priv->assoc_request.assoc_type = HC_IBSS_START;
7408 priv->assoc_request.assoc_tsf_msw = 0;
7409 priv->assoc_request.assoc_tsf_lsw = 0;
7410 } else {
7411 if (unlikely(roaming))
7412 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7413 else
7414 priv->assoc_request.assoc_type = HC_ASSOCIATE;
Al Viro5b5e8072007-12-27 01:54:06 -05007415 priv->assoc_request.assoc_tsf_msw = cpu_to_le32(network->time_stamp[1]);
7416 priv->assoc_request.assoc_tsf_lsw = cpu_to_le32(network->time_stamp[0]);
James Ketrenos43f66a62005-03-25 12:31:53 -06007417 }
7418
James Ketrenosafbf30a2005-08-25 00:05:33 -05007419 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007420
7421 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7422 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
Al Viro5b5e8072007-12-27 01:54:06 -05007423 priv->assoc_request.atim_window = cpu_to_le16(network->atim_window);
James Ketrenos43f66a62005-03-25 12:31:53 -06007424 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007425 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007426 priv->assoc_request.atim_window = 0;
7427 }
7428
Al Viro5b5e8072007-12-27 01:54:06 -05007429 priv->assoc_request.listen_interval = cpu_to_le16(network->listen_interval);
Jeff Garzikbf794512005-07-31 13:07:26 -04007430
James Ketrenos43f66a62005-03-25 12:31:53 -06007431 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7432 if (err) {
7433 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7434 return err;
7435 }
7436
7437 rates->ieee_mode = priv->assoc_request.ieee_mode;
7438 rates->purpose = IPW_RATE_CONNECT;
7439 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007440
James Ketrenos43f66a62005-03-25 12:31:53 -06007441 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7442 priv->sys_config.dot11g_auto_detection = 1;
7443 else
7444 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007445
7446 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7447 priv->sys_config.answer_broadcast_ssid_probe = 1;
7448 else
7449 priv->sys_config.answer_broadcast_ssid_probe = 0;
7450
Zhu Yid685b8c2006-04-13 17:20:27 +08007451 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007452 if (err) {
7453 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7454 return err;
7455 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007456
James Ketrenos43f66a62005-03-25 12:31:53 -06007457 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007458 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007459 if (err) {
7460 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7461 return err;
7462 }
7463
7464 /*
7465 * If preemption is enabled, it is possible for the association
7466 * to complete before we return from ipw_send_associate. Therefore
7467 * we have to be sure and update our priviate data first.
7468 */
7469 priv->channel = network->channel;
7470 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007471 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007472 priv->status &= ~STATUS_SECURITY_UPDATED;
7473
7474 priv->assoc_network = network;
7475
Zhu Yie43e3c12006-04-13 17:20:45 +08007476#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007477 ipw_qos_association(priv, network);
7478#endif
7479
James Ketrenos43f66a62005-03-25 12:31:53 -06007480 err = ipw_send_associate(priv, &priv->assoc_request);
7481 if (err) {
7482 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7483 return err;
7484 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007485
Johannes Berge1749612008-10-27 15:59:26 -07007486 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' %pM \n",
John W. Linville9387b7c2008-09-30 20:59:05 -04007487 print_ssid(ssid, priv->essid, priv->essid_len),
Johannes Berge1749612008-10-27 15:59:26 -07007488 priv->bssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007489
7490 return 0;
7491}
7492
7493static void ipw_roam(void *data)
7494{
7495 struct ipw_priv *priv = data;
7496 struct ieee80211_network *network = NULL;
7497 struct ipw_network_match match = {
7498 .network = priv->assoc_network
7499 };
7500
7501 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007502 *
7503 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007504 * setting the status ROAM bit and requesting a scan.
7505 * 2. When the scan completes, it schedules the ROAM work
7506 * 3. The ROAM work looks at all of the known networks for one that
7507 * is a better network than the currently associated. If none
7508 * found, the ROAM process is over (ROAM bit cleared)
7509 * 4. If a better network is found, a disassociation request is
7510 * sent.
7511 * 5. When the disassociation completes, the roam work is again
7512 * scheduled. The second time through, the driver is no longer
7513 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007514 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007515 * 6. At this point ,the roaming process is complete and the ROAM
7516 * status bit is cleared.
7517 */
7518
7519 /* If we are no longer associated, and the roaming bit is no longer
7520 * set, then we are not actively roaming, so just return */
7521 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7522 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007523
James Ketrenos43f66a62005-03-25 12:31:53 -06007524 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007525 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007526 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007527 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007528 u8 rssi = priv->assoc_network->stats.rssi;
7529 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007530 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007531 list_for_each_entry(network, &priv->ieee->network_list, list) {
7532 if (network != priv->assoc_network)
7533 ipw_best_network(priv, &match, network, 1);
7534 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007535 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007536 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007537
James Ketrenos43f66a62005-03-25 12:31:53 -06007538 if (match.network == priv->assoc_network) {
7539 IPW_DEBUG_ASSOC("No better APs in this network to "
7540 "roam to.\n");
7541 priv->status &= ~STATUS_ROAMING;
7542 ipw_debug_config(priv);
7543 return;
7544 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007545
James Ketrenos43f66a62005-03-25 12:31:53 -06007546 ipw_send_disassociate(priv, 1);
7547 priv->assoc_network = match.network;
7548
7549 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007550 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007551
7552 /* Second pass through ROAM process -- request association */
7553 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7554 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7555 priv->status &= ~STATUS_ROAMING;
7556}
7557
David Howellsc4028952006-11-22 14:57:56 +00007558static void ipw_bg_roam(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -05007559{
David Howellsc4028952006-11-22 14:57:56 +00007560 struct ipw_priv *priv =
7561 container_of(work, struct ipw_priv, roam);
Zhu Yi46441512006-01-24 16:37:59 +08007562 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007563 ipw_roam(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007564 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007565}
7566
7567static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007568{
7569 struct ipw_priv *priv = data;
7570
7571 struct ieee80211_network *network = NULL;
7572 struct ipw_network_match match = {
7573 .network = NULL
7574 };
7575 struct ipw_supported_rates *rates;
7576 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007577 unsigned long flags;
John W. Linville9387b7c2008-09-30 20:59:05 -04007578 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06007579
James Ketrenosb095c382005-08-24 22:04:42 -05007580 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7581 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7582 return 0;
7583 }
7584
James Ketrenosc848d0a2005-08-24 21:56:24 -05007585 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007586 IPW_DEBUG_ASSOC("Not attempting association (already in "
7587 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007588 return 0;
7589 }
7590
Hong Liue6324722005-09-14 21:04:15 -05007591 if (priv->status & STATUS_DISASSOCIATING) {
7592 IPW_DEBUG_ASSOC("Not attempting association (in "
7593 "disassociating)\n ");
7594 queue_work(priv->workqueue, &priv->associate);
7595 return 0;
7596 }
7597
James Ketrenosc848d0a2005-08-24 21:56:24 -05007598 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007599 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7600 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007601 return 0;
7602 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007603
7604 if (!(priv->config & CFG_ASSOCIATE) &&
Alexey Fisher3e4127f2008-11-06 09:51:16 +01007605 !(priv->config & (CFG_STATIC_ESSID | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007606 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007607 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007608 }
7609
James Ketrenosa613bff2005-08-24 21:43:11 -05007610 /* Protect our use of the network_list */
7611 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007612 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007613 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007614
7615 network = match.network;
7616 rates = &match.rates;
7617
7618 if (network == NULL &&
7619 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7620 priv->config & CFG_ADHOC_CREATE &&
7621 priv->config & CFG_STATIC_ESSID &&
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007622 priv->config & CFG_STATIC_CHANNEL) {
7623 /* Use oldest network if the free list is empty */
7624 if (list_empty(&priv->ieee->network_free_list)) {
7625 struct ieee80211_network *oldest = NULL;
7626 struct ieee80211_network *target;
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007627
7628 list_for_each_entry(target, &priv->ieee->network_list, list) {
7629 if ((oldest == NULL) ||
7630 (target->last_scanned < oldest->last_scanned))
7631 oldest = target;
7632 }
7633
7634 /* If there are no more slots, expire the oldest */
7635 list_del(&oldest->list);
7636 target = oldest;
Johannes Berge1749612008-10-27 15:59:26 -07007637 IPW_DEBUG_ASSOC("Expired '%s' (%pM) from "
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007638 "network list.\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04007639 print_ssid(ssid, target->ssid,
7640 target->ssid_len),
Johannes Berge1749612008-10-27 15:59:26 -07007641 target->bssid);
Dan Williamsa6d4eae2008-05-29 14:38:28 -04007642 list_add_tail(&target->list,
7643 &priv->ieee->network_free_list);
7644 }
7645
James Ketrenos43f66a62005-03-25 12:31:53 -06007646 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007647 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007648 ipw_adhoc_create(priv, network);
7649 rates = &priv->rates;
7650 list_del(element);
7651 list_add_tail(&network->list, &priv->ieee->network_list);
7652 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007653 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007654
James Ketrenos43f66a62005-03-25 12:31:53 -06007655 /* If we reached the end of the list, then we don't have any valid
7656 * matching APs */
7657 if (!network) {
7658 ipw_debug_config(priv);
7659
James Ketrenosb095c382005-08-24 22:04:42 -05007660 if (!(priv->status & STATUS_SCANNING)) {
7661 if (!(priv->config & CFG_SPEED_SCAN))
7662 queue_delayed_work(priv->workqueue,
7663 &priv->request_scan,
7664 SCAN_INTERVAL);
7665 else
David Howellsc4028952006-11-22 14:57:56 +00007666 queue_delayed_work(priv->workqueue,
7667 &priv->request_scan, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05007668 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007669
James Ketrenosc848d0a2005-08-24 21:56:24 -05007670 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007671 }
7672
7673 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007674
7675 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007676}
Jeff Garzikbf794512005-07-31 13:07:26 -04007677
David Howellsc4028952006-11-22 14:57:56 +00007678static void ipw_bg_associate(struct work_struct *work)
James Ketrenos43f66a62005-03-25 12:31:53 -06007679{
David Howellsc4028952006-11-22 14:57:56 +00007680 struct ipw_priv *priv =
7681 container_of(work, struct ipw_priv, associate);
Zhu Yi46441512006-01-24 16:37:59 +08007682 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +00007683 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08007684 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007685}
7686
James Ketrenosb095c382005-08-24 22:04:42 -05007687static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7688 struct sk_buff *skb)
7689{
7690 struct ieee80211_hdr *hdr;
7691 u16 fc;
7692
7693 hdr = (struct ieee80211_hdr *)skb->data;
John W. Linville72118012008-09-30 21:43:03 -04007694 fc = le16_to_cpu(hdr->frame_control);
James Ketrenosb095c382005-08-24 22:04:42 -05007695 if (!(fc & IEEE80211_FCTL_PROTECTED))
7696 return;
7697
7698 fc &= ~IEEE80211_FCTL_PROTECTED;
John W. Linville72118012008-09-30 21:43:03 -04007699 hdr->frame_control = cpu_to_le16(fc);
James Ketrenosb095c382005-08-24 22:04:42 -05007700 switch (priv->ieee->sec.level) {
7701 case SEC_LEVEL_3:
7702 /* Remove CCMP HDR */
7703 memmove(skb->data + IEEE80211_3ADDR_LEN,
7704 skb->data + IEEE80211_3ADDR_LEN + 8,
7705 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007706 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007707 break;
7708 case SEC_LEVEL_2:
7709 break;
7710 case SEC_LEVEL_1:
7711 /* Remove IV */
7712 memmove(skb->data + IEEE80211_3ADDR_LEN,
7713 skb->data + IEEE80211_3ADDR_LEN + 4,
7714 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007715 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007716 break;
7717 case SEC_LEVEL_0:
7718 break;
7719 default:
7720 printk(KERN_ERR "Unknow security level %d\n",
7721 priv->ieee->sec.level);
7722 break;
7723 }
7724}
7725
7726static void ipw_handle_data_packet(struct ipw_priv *priv,
7727 struct ipw_rx_mem_buffer *rxb,
7728 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007729{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007730 struct net_device *dev = priv->net_dev;
Hong Liu567deaf2005-08-31 18:07:22 +08007731 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007732 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7733
7734 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007735 dev->trans_start = jiffies;
James Ketrenos43f66a62005-03-25 12:31:53 -06007736
Jeff Garzikbf794512005-07-31 13:07:26 -04007737 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007738 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007739 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007740 skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007741 dev->stats.rx_errors++;
James Ketrenos43f66a62005-03-25 12:31:53 -06007742 priv->wstats.discard.misc++;
7743 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7744 return;
7745 } else if (unlikely(!netif_running(priv->net_dev))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007746 dev->stats.rx_dropped++;
James Ketrenos43f66a62005-03-25 12:31:53 -06007747 priv->wstats.discard.misc++;
7748 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7749 return;
7750 }
7751
7752 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007753 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007754
7755 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007756 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007757
7758 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7759
James Ketrenosb095c382005-08-24 22:04:42 -05007760 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007761 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7762 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007763 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007764 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007765 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7766
Jeff Garzikbf794512005-07-31 13:07:26 -04007767 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007768 dev->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007769 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007770 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007771 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007772 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007773}
7774
Zhu Yi459d4082006-04-13 17:21:00 +08007775#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007776static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7777 struct ipw_rx_mem_buffer *rxb,
7778 struct ieee80211_rx_stats *stats)
7779{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007780 struct net_device *dev = priv->net_dev;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007781 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7782 struct ipw_rx_frame *frame = &pkt->u.frame;
7783
7784 /* initial pull of some data */
7785 u16 received_channel = frame->received_channel;
7786 u8 antennaAndPhy = frame->antennaAndPhy;
7787 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7788 u16 pktrate = frame->rate;
7789
7790 /* Magic struct that slots into the radiotap header -- no reason
7791 * to build this manually element by element, we can write it much
7792 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007793 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007794
7795 short len = le16_to_cpu(pkt->u.frame.length);
7796
7797 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007798 dev->trans_start = jiffies;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007799
7800 /* We only process data packets if the
7801 * interface is open */
7802 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7803 skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007804 dev->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007805 priv->wstats.discard.misc++;
7806 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7807 return;
7808 } else if (unlikely(!netif_running(priv->net_dev))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007809 dev->stats.rx_dropped++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007810 priv->wstats.discard.misc++;
7811 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7812 return;
7813 }
7814
7815 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7816 * that now */
7817 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7818 /* FIXME: Should alloc bigger skb instead */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007819 dev->stats.rx_dropped++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007820 priv->wstats.discard.misc++;
7821 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7822 return;
7823 }
7824
7825 /* copy the frame itself */
7826 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7827 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7828
Mike Kershaw24a47db2005-08-26 00:41:54 -05007829 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7830
7831 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7832 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05007833 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(struct ipw_rt_hdr)); /* total header+data */
Mike Kershaw24a47db2005-08-26 00:41:54 -05007834
7835 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05007836 ipw_rt->rt_hdr.it_present = cpu_to_le32(
7837 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007838 (1 << IEEE80211_RADIOTAP_FLAGS) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007839 (1 << IEEE80211_RADIOTAP_RATE) |
7840 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7841 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007842 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007843 (1 << IEEE80211_RADIOTAP_ANTENNA));
7844
7845 /* Zero the flags, we'll add to them as we go */
7846 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08007847 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
7848 frame->parent_tsf[2] << 16 |
7849 frame->parent_tsf[1] << 8 |
7850 frame->parent_tsf[0]);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007851
7852 /* Convert signal to DBM */
7853 ipw_rt->rt_dbmsignal = antsignal;
Reinette Chatre21f8a732009-08-18 10:25:05 -07007854 ipw_rt->rt_dbmnoise = (s8) le16_to_cpu(frame->noise);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007855
7856 /* Convert the channel data and set the flags */
7857 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7858 if (received_channel > 14) { /* 802.11a */
7859 ipw_rt->rt_chbitmask =
7860 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7861 } else if (antennaAndPhy & 32) { /* 802.11b */
7862 ipw_rt->rt_chbitmask =
7863 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7864 } else { /* 802.11g */
7865 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05007866 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Mike Kershaw24a47db2005-08-26 00:41:54 -05007867 }
7868
7869 /* set the rate in multiples of 500k/s */
7870 switch (pktrate) {
7871 case IPW_TX_RATE_1MB:
7872 ipw_rt->rt_rate = 2;
7873 break;
7874 case IPW_TX_RATE_2MB:
7875 ipw_rt->rt_rate = 4;
7876 break;
7877 case IPW_TX_RATE_5MB:
7878 ipw_rt->rt_rate = 10;
7879 break;
7880 case IPW_TX_RATE_6MB:
7881 ipw_rt->rt_rate = 12;
7882 break;
7883 case IPW_TX_RATE_9MB:
7884 ipw_rt->rt_rate = 18;
7885 break;
7886 case IPW_TX_RATE_11MB:
7887 ipw_rt->rt_rate = 22;
7888 break;
7889 case IPW_TX_RATE_12MB:
7890 ipw_rt->rt_rate = 24;
7891 break;
7892 case IPW_TX_RATE_18MB:
7893 ipw_rt->rt_rate = 36;
7894 break;
7895 case IPW_TX_RATE_24MB:
7896 ipw_rt->rt_rate = 48;
7897 break;
7898 case IPW_TX_RATE_36MB:
7899 ipw_rt->rt_rate = 72;
7900 break;
7901 case IPW_TX_RATE_48MB:
7902 ipw_rt->rt_rate = 96;
7903 break;
7904 case IPW_TX_RATE_54MB:
7905 ipw_rt->rt_rate = 108;
7906 break;
7907 default:
7908 ipw_rt->rt_rate = 0;
7909 break;
7910 }
7911
7912 /* antenna number */
7913 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7914
7915 /* set the preamble flag if we have it */
7916 if ((antennaAndPhy & 64))
7917 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7918
7919 /* Set the size of the skb to the size of the frame */
7920 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007921
7922 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7923
7924 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007925 dev->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007926 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007927 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007928 /* no LED during capture */
7929 }
7930}
7931#endif
7932
Zhu Yid685b8c2006-04-13 17:20:27 +08007933#ifdef CONFIG_IPW2200_PROMISCUOUS
7934#define ieee80211_is_probe_response(fc) \
7935 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7936 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7937
7938#define ieee80211_is_management(fc) \
7939 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7940
7941#define ieee80211_is_control(fc) \
7942 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7943
7944#define ieee80211_is_data(fc) \
7945 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7946
7947#define ieee80211_is_assoc_request(fc) \
7948 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7949
7950#define ieee80211_is_reassoc_request(fc) \
7951 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7952
7953static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7954 struct ipw_rx_mem_buffer *rxb,
7955 struct ieee80211_rx_stats *stats)
7956{
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007957 struct net_device *dev = priv->prom_net_dev;
Zhu Yid685b8c2006-04-13 17:20:27 +08007958 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7959 struct ipw_rx_frame *frame = &pkt->u.frame;
7960 struct ipw_rt_hdr *ipw_rt;
7961
7962 /* First cache any information we need before we overwrite
7963 * the information provided in the skb from the hardware */
7964 struct ieee80211_hdr *hdr;
7965 u16 channel = frame->received_channel;
7966 u8 phy_flags = frame->antennaAndPhy;
7967 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
Reinette Chatre21f8a732009-08-18 10:25:05 -07007968 s8 noise = (s8) le16_to_cpu(frame->noise);
Zhu Yid685b8c2006-04-13 17:20:27 +08007969 u8 rate = frame->rate;
7970 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007971 struct sk_buff *skb;
7972 int hdr_only = 0;
7973 u16 filter = priv->prom_priv->filter;
7974
7975 /* If the filter is set to not include Rx frames then return */
7976 if (filter & IPW_PROM_NO_RX)
7977 return;
7978
Zhu Yid685b8c2006-04-13 17:20:27 +08007979 /* We received data from the HW, so stop the watchdog */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007980 dev->trans_start = jiffies;
Zhu Yid685b8c2006-04-13 17:20:27 +08007981
7982 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007983 dev->stats.rx_errors++;
Zhu Yid685b8c2006-04-13 17:20:27 +08007984 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7985 return;
7986 }
7987
7988 /* We only process data packets if the interface is open */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007989 if (unlikely(!netif_running(dev))) {
7990 dev->stats.rx_dropped++;
Zhu Yid685b8c2006-04-13 17:20:27 +08007991 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7992 return;
7993 }
7994
7995 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7996 * that now */
7997 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7998 /* FIXME: Should alloc bigger skb instead */
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00007999 dev->stats.rx_dropped++;
Zhu Yid685b8c2006-04-13 17:20:27 +08008000 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
8001 return;
8002 }
8003
8004 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
John W. Linville72118012008-09-30 21:43:03 -04008005 if (ieee80211_is_management(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008006 if (filter & IPW_PROM_NO_MGMT)
8007 return;
8008 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
8009 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -04008010 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008011 if (filter & IPW_PROM_NO_CTL)
8012 return;
8013 if (filter & IPW_PROM_CTL_HEADER_ONLY)
8014 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -04008015 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08008016 if (filter & IPW_PROM_NO_DATA)
8017 return;
8018 if (filter & IPW_PROM_DATA_HEADER_ONLY)
8019 hdr_only = 1;
8020 }
8021
8022 /* Copy the SKB since this is for the promiscuous side */
8023 skb = skb_copy(rxb->skb, GFP_ATOMIC);
8024 if (skb == NULL) {
8025 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
8026 return;
8027 }
8028
8029 /* copy the frame data to write after where the radiotap header goes */
8030 ipw_rt = (void *)skb->data;
8031
8032 if (hdr_only)
John W. Linville72118012008-09-30 21:43:03 -04008033 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_control));
Zhu Yid685b8c2006-04-13 17:20:27 +08008034
8035 memcpy(ipw_rt->payload, hdr, len);
8036
Zhu Yid685b8c2006-04-13 17:20:27 +08008037 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
8038 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
Al Viro743b84d2007-12-27 01:43:16 -05008039 ipw_rt->rt_hdr.it_len = cpu_to_le16(sizeof(*ipw_rt)); /* total header+data */
Zhu Yid685b8c2006-04-13 17:20:27 +08008040
8041 /* Set the size of the skb to the size of the frame */
Al Viro743b84d2007-12-27 01:43:16 -05008042 skb_put(skb, sizeof(*ipw_rt) + len);
Zhu Yid685b8c2006-04-13 17:20:27 +08008043
8044 /* Big bitfield of all the fields we provide in radiotap */
Al Viro743b84d2007-12-27 01:43:16 -05008045 ipw_rt->rt_hdr.it_present = cpu_to_le32(
8046 (1 << IEEE80211_RADIOTAP_TSFT) |
Zhu Yi4b1f8a92006-12-05 14:42:14 +08008047 (1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08008048 (1 << IEEE80211_RADIOTAP_RATE) |
8049 (1 << IEEE80211_RADIOTAP_CHANNEL) |
8050 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
8051 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
8052 (1 << IEEE80211_RADIOTAP_ANTENNA));
8053
8054 /* Zero the flags, we'll add to them as we go */
8055 ipw_rt->rt_flags = 0;
Zhu Yi4b1f8a92006-12-05 14:42:14 +08008056 ipw_rt->rt_tsf = (u64)(frame->parent_tsf[3] << 24 |
8057 frame->parent_tsf[2] << 16 |
8058 frame->parent_tsf[1] << 8 |
8059 frame->parent_tsf[0]);
Zhu Yid685b8c2006-04-13 17:20:27 +08008060
8061 /* Convert to DBM */
8062 ipw_rt->rt_dbmsignal = signal;
8063 ipw_rt->rt_dbmnoise = noise;
8064
8065 /* Convert the channel data and set the flags */
8066 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
8067 if (channel > 14) { /* 802.11a */
8068 ipw_rt->rt_chbitmask =
8069 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
8070 } else if (phy_flags & (1 << 5)) { /* 802.11b */
8071 ipw_rt->rt_chbitmask =
8072 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
8073 } else { /* 802.11g */
8074 ipw_rt->rt_chbitmask =
Al Viro472caf82007-12-27 01:50:54 -05008075 cpu_to_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
Zhu Yid685b8c2006-04-13 17:20:27 +08008076 }
8077
8078 /* set the rate in multiples of 500k/s */
8079 switch (rate) {
8080 case IPW_TX_RATE_1MB:
8081 ipw_rt->rt_rate = 2;
8082 break;
8083 case IPW_TX_RATE_2MB:
8084 ipw_rt->rt_rate = 4;
8085 break;
8086 case IPW_TX_RATE_5MB:
8087 ipw_rt->rt_rate = 10;
8088 break;
8089 case IPW_TX_RATE_6MB:
8090 ipw_rt->rt_rate = 12;
8091 break;
8092 case IPW_TX_RATE_9MB:
8093 ipw_rt->rt_rate = 18;
8094 break;
8095 case IPW_TX_RATE_11MB:
8096 ipw_rt->rt_rate = 22;
8097 break;
8098 case IPW_TX_RATE_12MB:
8099 ipw_rt->rt_rate = 24;
8100 break;
8101 case IPW_TX_RATE_18MB:
8102 ipw_rt->rt_rate = 36;
8103 break;
8104 case IPW_TX_RATE_24MB:
8105 ipw_rt->rt_rate = 48;
8106 break;
8107 case IPW_TX_RATE_36MB:
8108 ipw_rt->rt_rate = 72;
8109 break;
8110 case IPW_TX_RATE_48MB:
8111 ipw_rt->rt_rate = 96;
8112 break;
8113 case IPW_TX_RATE_54MB:
8114 ipw_rt->rt_rate = 108;
8115 break;
8116 default:
8117 ipw_rt->rt_rate = 0;
8118 break;
8119 }
8120
8121 /* antenna number */
8122 ipw_rt->rt_antenna = (phy_flags & 3);
8123
8124 /* set the preamble flag if we have it */
8125 if (phy_flags & (1 << 6))
8126 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
8127
8128 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
8129
8130 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00008131 dev->stats.rx_errors++;
Zhu Yid685b8c2006-04-13 17:20:27 +08008132 dev_kfree_skb_any(skb);
8133 }
8134}
8135#endif
8136
Arjan van de Ven858119e2006-01-14 13:20:43 -08008137static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05008138 struct ieee80211_hdr_4addr *header)
8139{
8140 /* Filter incoming packets to determine if they are targetted toward
8141 * this network, discarding packets coming from ourselves */
8142 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05008143 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008144 /* packets from our adapter are dropped (echo) */
8145 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
8146 return 0;
8147
Peter Jones90700fd2005-08-26 16:51:06 -05008148 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008149 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05008150 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008151
8152 /* packets to our adapter go through */
8153 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8154 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05008155
Peter Jones90700fd2005-08-26 16:51:06 -05008156 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05008157 /* packets from our adapter are dropped (echo) */
8158 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
8159 return 0;
8160
Peter Jones90700fd2005-08-26 16:51:06 -05008161 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08008162 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05008163 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
8164
8165 /* packets to our adapter go through */
8166 return !memcmp(header->addr1, priv->net_dev->dev_addr,
8167 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05008168 }
James Ketrenosa613bff2005-08-24 21:43:11 -05008169
James Ketrenosea2b26e2005-08-24 21:25:16 -05008170 return 1;
8171}
8172
James Ketrenosafbf30a2005-08-25 00:05:33 -05008173#define IPW_PACKET_RETRY_TIME HZ
8174
Arjan van de Ven858119e2006-01-14 13:20:43 -08008175static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05008176 struct ieee80211_hdr_4addr *header)
8177{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008178 u16 sc = le16_to_cpu(header->seq_ctl);
8179 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8180 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8181 u16 *last_seq, *last_frag;
8182 unsigned long *last_time;
8183
8184 switch (priv->ieee->iw_mode) {
8185 case IW_MODE_ADHOC:
8186 {
8187 struct list_head *p;
8188 struct ipw_ibss_seq *entry = NULL;
8189 u8 *mac = header->addr2;
8190 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8191
8192 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8193 entry =
8194 list_entry(p, struct ipw_ibss_seq, list);
8195 if (!memcmp(entry->mac, mac, ETH_ALEN))
8196 break;
8197 }
8198 if (p == &priv->ibss_mac_hash[index]) {
8199 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8200 if (!entry) {
8201 IPW_ERROR
8202 ("Cannot malloc new mac entry\n");
8203 return 0;
8204 }
8205 memcpy(entry->mac, mac, ETH_ALEN);
8206 entry->seq_num = seq;
8207 entry->frag_num = frag;
8208 entry->packet_time = jiffies;
8209 list_add(&entry->list,
8210 &priv->ibss_mac_hash[index]);
8211 return 0;
8212 }
8213 last_seq = &entry->seq_num;
8214 last_frag = &entry->frag_num;
8215 last_time = &entry->packet_time;
8216 break;
8217 }
8218 case IW_MODE_INFRA:
8219 last_seq = &priv->last_seq_num;
8220 last_frag = &priv->last_frag_num;
8221 last_time = &priv->last_packet_time;
8222 break;
8223 default:
8224 return 0;
8225 }
8226 if ((*last_seq == seq) &&
8227 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8228 if (*last_frag == frag)
8229 goto drop;
8230 if (*last_frag + 1 != frag)
8231 /* out-of-order fragment */
8232 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008233 } else
8234 *last_seq = seq;
8235
Zhu Yif57ce7c2005-07-13 12:22:15 -05008236 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008237 *last_time = jiffies;
8238 return 0;
8239
8240 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008241 /* Comment this line now since we observed the card receives
8242 * duplicate packets but the FCTL_RETRY bit is not set in the
8243 * IBSS mode with fragmentation enabled.
John W. Linville72118012008-09-30 21:43:03 -04008244 BUG_ON(!(le16_to_cpu(header->frame_control) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008245 return 1;
8246}
8247
James Ketrenosb095c382005-08-24 22:04:42 -05008248static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8249 struct ipw_rx_mem_buffer *rxb,
8250 struct ieee80211_rx_stats *stats)
8251{
8252 struct sk_buff *skb = rxb->skb;
8253 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8254 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8255 (skb->data + IPW_RX_FRAME_SIZE);
8256
8257 ieee80211_rx_mgt(priv->ieee, header, stats);
8258
8259 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8260 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8261 IEEE80211_STYPE_PROBE_RESP) ||
8262 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8263 IEEE80211_STYPE_BEACON))) {
8264 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8265 ipw_add_station(priv, header->addr2);
8266 }
8267
8268 if (priv->config & CFG_NET_STATS) {
8269 IPW_DEBUG_HC("sending stat packet\n");
8270
8271 /* Set the size of the skb to the size of the full
8272 * ipw header and 802.11 frame */
8273 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8274 IPW_RX_FRAME_SIZE);
8275
8276 /* Advance past the ipw packet header to the 802.11 frame */
8277 skb_pull(skb, IPW_RX_FRAME_SIZE);
8278
8279 /* Push the ieee80211_rx_stats before the 802.11 frame */
8280 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8281
8282 skb->dev = priv->ieee->dev;
8283
8284 /* Point raw at the ieee80211_stats */
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07008285 skb_reset_mac_header(skb);
James Ketrenosb095c382005-08-24 22:04:42 -05008286
8287 skb->pkt_type = PACKET_OTHERHOST;
Harvey Harrisonc1b4aa32009-01-29 13:26:44 -08008288 skb->protocol = cpu_to_be16(ETH_P_80211_STATS);
James Ketrenosb095c382005-08-24 22:04:42 -05008289 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8290 netif_rx(skb);
8291 rxb->skb = NULL;
8292 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008293}
8294
James Ketrenos43f66a62005-03-25 12:31:53 -06008295/*
8296 * Main entry function for recieving a packet with 80211 headers. This
8297 * should be called when ever the FW has notified us that there is a new
8298 * skb in the recieve queue.
8299 */
8300static void ipw_rx(struct ipw_priv *priv)
8301{
8302 struct ipw_rx_mem_buffer *rxb;
8303 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008304 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008305 u32 r, w, i;
8306 u8 network_packet;
Dan Williams943dbef2008-02-14 17:49:41 -05008307 u8 fill_rx = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008308
James Ketrenosb095c382005-08-24 22:04:42 -05008309 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8310 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
Dan Williams943dbef2008-02-14 17:49:41 -05008311 i = priv->rxq->read;
8312
8313 if (ipw_rx_queue_space (priv->rxq) > (RX_QUEUE_SIZE / 2))
8314 fill_rx = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008315
8316 while (i != r) {
8317 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008318 if (unlikely(rxb == NULL)) {
8319 printk(KERN_CRIT "Queue not allocated!\n");
8320 break;
8321 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008322 priv->rxq->queue[i] = NULL;
8323
8324 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008325 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008326 PCI_DMA_FROMDEVICE);
8327
8328 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8329 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8330 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008331 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008332
8333 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008334 case RX_FRAME_TYPE: /* 802.11 frame */ {
8335 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008336 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008337 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008338 .signal =
Reinette Chatre21f8a732009-08-18 10:25:05 -07008339 pkt->u.frame.rssi_dbm -
Bill Mossb1916082006-02-15 08:50:18 +08008340 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008341 .noise =
8342 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008343 .rate = pkt->u.frame.rate,
8344 .mac_time = jiffies,
8345 .received_channel =
8346 pkt->u.frame.received_channel,
8347 .freq =
8348 (pkt->u.frame.
8349 control & (1 << 0)) ?
8350 IEEE80211_24GHZ_BAND :
8351 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008352 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008353 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008354
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008355 if (stats.rssi != 0)
8356 stats.mask |= IEEE80211_STATMASK_RSSI;
8357 if (stats.signal != 0)
8358 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008359 if (stats.noise != 0)
8360 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008361 if (stats.rate != 0)
8362 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008363
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008364 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008365
Zhu Yid685b8c2006-04-13 17:20:27 +08008366#ifdef CONFIG_IPW2200_PROMISCUOUS
8367 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8368 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8369#endif
8370
James Ketrenosb095c382005-08-24 22:04:42 -05008371#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008372 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008373#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008374
8375 ipw_handle_data_packet_monitor(priv,
8376 rxb,
8377 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008378#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008379 ipw_handle_data_packet(priv, rxb,
8380 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008381#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008382 break;
8383 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008384#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008385
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008386 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008387 (struct ieee80211_hdr_4addr *)(rxb->skb->
8388 data +
8389 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008390 /* TODO: Check Ad-Hoc dest/source and make sure
8391 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008392 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008393 * frame control of the packet and disregard
8394 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008395
James Ketrenosea2b26e2005-08-24 21:25:16 -05008396 network_packet =
8397 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008398 if (network_packet && priv->assoc_network) {
8399 priv->assoc_network->stats.rssi =
8400 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008401 priv->exp_avg_rssi =
8402 exponential_average(priv->exp_avg_rssi,
8403 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008404 }
8405
8406 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008407 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008408
James Ketrenosa613bff2005-08-24 21:43:11 -05008409 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008410 ieee80211_get_hdrlen(le16_to_cpu(
8411 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008412 IPW_DEBUG_DROP
8413 ("Received packet is too small. "
8414 "Dropping.\n");
Stephen Hemmingerce55cba2009-03-20 19:36:38 +00008415 priv->net_dev->stats.rx_errors++;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008416 priv->wstats.discard.misc++;
8417 break;
8418 }
8419
James Ketrenosa613bff2005-08-24 21:43:11 -05008420 switch (WLAN_FC_GET_TYPE
8421 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008422
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008423 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008424 ipw_handle_mgmt_packet(priv, rxb,
8425 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008426 break;
8427
8428 case IEEE80211_FTYPE_CTL:
8429 break;
8430
8431 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008432 if (unlikely(!network_packet ||
8433 is_duplicate_packet(priv,
8434 header)))
8435 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008436 IPW_DEBUG_DROP("Dropping: "
Johannes Berge1749612008-10-27 15:59:26 -07008437 "%pM, "
8438 "%pM, "
8439 "%pM\n",
8440 header->addr1,
8441 header->addr2,
8442 header->addr3);
James Ketrenosb095c382005-08-24 22:04:42 -05008443 break;
8444 }
8445
8446 ipw_handle_data_packet(priv, rxb,
8447 &stats);
8448
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008449 break;
8450 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008451 break;
8452 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008453
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008454 case RX_HOST_NOTIFICATION_TYPE:{
8455 IPW_DEBUG_RX
8456 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008457 pkt->u.notification.subtype,
8458 pkt->u.notification.flags,
Zhu Yi720eeb42006-12-05 14:41:40 +08008459 le16_to_cpu(pkt->u.notification.size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008460 ipw_rx_notification(priv, &pkt->u.notification);
8461 break;
8462 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008463
8464 default:
8465 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8466 pkt->header.message_type);
8467 break;
8468 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008469
8470 /* For now we just don't re-use anything. We can tweak this
8471 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008472 * fail to Rx correctly */
8473 if (rxb->skb != NULL) {
8474 dev_kfree_skb_any(rxb->skb);
8475 rxb->skb = NULL;
8476 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008477
James Ketrenos43f66a62005-03-25 12:31:53 -06008478 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008479 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008480 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008481
James Ketrenos43f66a62005-03-25 12:31:53 -06008482 i = (i + 1) % RX_QUEUE_SIZE;
Dan Williams943dbef2008-02-14 17:49:41 -05008483
8484 /* If there are a lot of unsued frames, restock the Rx queue
8485 * so the ucode won't assert */
8486 if (fill_rx) {
8487 priv->rxq->read = i;
8488 ipw_rx_queue_replenish(priv);
8489 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008490 }
8491
8492 /* Backtrack one entry */
Dan Williams943dbef2008-02-14 17:49:41 -05008493 priv->rxq->read = i;
James Ketrenos43f66a62005-03-25 12:31:53 -06008494 ipw_rx_queue_restock(priv);
8495}
8496
James Ketrenosafbf30a2005-08-25 00:05:33 -05008497#define DEFAULT_RTS_THRESHOLD 2304U
8498#define MIN_RTS_THRESHOLD 1U
8499#define MAX_RTS_THRESHOLD 2304U
8500#define DEFAULT_BEACON_INTERVAL 100U
8501#define DEFAULT_SHORT_RETRY_LIMIT 7U
8502#define DEFAULT_LONG_RETRY_LIMIT 4U
8503
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008504/**
8505 * ipw_sw_reset
8506 * @option: options to control different reset behaviour
8507 * 0 = reset everything except the 'disable' module_param
8508 * 1 = reset everything and print out driver info (for probe only)
8509 * 2 = reset everything
8510 */
8511static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008512{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008513 int band, modulation;
8514 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008515
James Ketrenosafbf30a2005-08-25 00:05:33 -05008516 /* Initialize module parameter values here */
8517 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008518
James Ketrenosafbf30a2005-08-25 00:05:33 -05008519 /* We default to disabling the LED code as right now it causes
8520 * too many systems to lock up... */
Reinette Chatre21f8a732009-08-18 10:25:05 -07008521 if (!led_support)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008522 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008523
James Ketrenosafbf30a2005-08-25 00:05:33 -05008524 if (associate)
8525 priv->config |= CFG_ASSOCIATE;
8526 else
8527 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008528
James Ketrenosafbf30a2005-08-25 00:05:33 -05008529 if (auto_create)
8530 priv->config |= CFG_ADHOC_CREATE;
8531 else
8532 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8533
Zhu Yi17ed0812006-01-24 16:36:31 +08008534 priv->config &= ~CFG_STATIC_ESSID;
8535 priv->essid_len = 0;
8536 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8537
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008538 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008539 priv->status |= STATUS_RF_KILL_SW;
8540 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008541 }
8542
Reinette Chatre21f8a732009-08-18 10:25:05 -07008543 if (default_channel != 0) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008544 priv->config |= CFG_STATIC_CHANNEL;
Reinette Chatre21f8a732009-08-18 10:25:05 -07008545 priv->channel = default_channel;
8546 IPW_DEBUG_INFO("Bind to static channel %d\n", default_channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008547 /* TODO: Validate that provided channel is in range */
8548 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008549#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008550 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8551 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008552#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008553
Reinette Chatre21f8a732009-08-18 10:25:05 -07008554 switch (network_mode) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008555 case 1:
8556 priv->ieee->iw_mode = IW_MODE_ADHOC;
8557 priv->net_dev->type = ARPHRD_ETHER;
8558
8559 break;
8560#ifdef CONFIG_IPW2200_MONITOR
8561 case 2:
8562 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008563#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008564 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8565#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008566 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008567#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008568 break;
8569#endif
8570 default:
8571 case 0:
8572 priv->net_dev->type = ARPHRD_ETHER;
8573 priv->ieee->iw_mode = IW_MODE_INFRA;
8574 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008575 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008576
James Ketrenosafbf30a2005-08-25 00:05:33 -05008577 if (hwcrypto) {
8578 priv->ieee->host_encrypt = 0;
8579 priv->ieee->host_encrypt_msdu = 0;
8580 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008581 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008582 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008583 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008584
Zhu Yie402c932005-08-05 17:20:40 +08008585 /* IPW2200/2915 is abled to do hardware fragmentation. */
8586 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008587
James Ketrenosafbf30a2005-08-25 00:05:33 -05008588 if ((priv->pci_dev->device == 0x4223) ||
8589 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008590 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008591 printk(KERN_INFO DRV_NAME
8592 ": Detected Intel PRO/Wireless 2915ABG Network "
8593 "Connection\n");
8594 priv->ieee->abg_true = 1;
8595 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8596 modulation = IEEE80211_OFDM_MODULATION |
8597 IEEE80211_CCK_MODULATION;
8598 priv->adapter = IPW_2915ABG;
8599 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008600 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008601 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008602 printk(KERN_INFO DRV_NAME
8603 ": Detected Intel PRO/Wireless 2200BG Network "
8604 "Connection\n");
8605
8606 priv->ieee->abg_true = 0;
8607 band = IEEE80211_24GHZ_BAND;
8608 modulation = IEEE80211_OFDM_MODULATION |
8609 IEEE80211_CCK_MODULATION;
8610 priv->adapter = IPW_2200BG;
8611 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008612 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008613
James Ketrenosafbf30a2005-08-25 00:05:33 -05008614 priv->ieee->freq_band = band;
8615 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008616
James Ketrenosafbf30a2005-08-25 00:05:33 -05008617 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008618
James Ketrenosafbf30a2005-08-25 00:05:33 -05008619 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8620 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008621
James Ketrenosafbf30a2005-08-25 00:05:33 -05008622 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8623 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8624 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008625
James Ketrenosafbf30a2005-08-25 00:05:33 -05008626 /* If power management is turned on, default to AC mode */
8627 priv->power_mode = IPW_POWER_AC;
8628 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008629
Zhu Yi0ece35b2005-08-05 17:26:51 +08008630 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008631}
8632
8633/*
8634 * This file defines the Wireless Extension handlers. It does not
8635 * define any methods of hardware manipulation and relies on the
8636 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008637 *
8638 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008639 * function used to poll the hardware vs. making unecessary calls.
8640 *
8641 */
8642
Jeff Garzikbf794512005-07-31 13:07:26 -04008643static int ipw_wx_get_name(struct net_device *dev,
8644 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008645 union iwreq_data *wrqu, char *extra)
8646{
8647 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008648 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008649 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008650 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008651 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008652 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008653 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008654 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8655 ipw_modes[priv->assoc_request.ieee_mode]);
8656 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008657 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008658 return 0;
8659}
8660
8661static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8662{
8663 if (channel == 0) {
8664 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8665 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008666 IPW_DEBUG_ASSOC("Attempting to associate with new "
8667 "parameters.\n");
8668 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008669 return 0;
8670 }
8671
8672 priv->config |= CFG_STATIC_CHANNEL;
8673
8674 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008675 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8676 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008677 return 0;
8678 }
8679
8680 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8681 priv->channel = channel;
8682
James Ketrenosb095c382005-08-24 22:04:42 -05008683#ifdef CONFIG_IPW2200_MONITOR
8684 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008685 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008686 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008687 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008688 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008689 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008690 }
8691
8692 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8693 udelay(10);
8694
8695 if (priv->status & STATUS_SCANNING)
8696 IPW_DEBUG_SCAN("Still scanning...\n");
8697 else
8698 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8699 1000 - i);
8700
8701 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008702 }
James Ketrenosb095c382005-08-24 22:04:42 -05008703#endif /* CONFIG_IPW2200_MONITOR */
8704
James Ketrenosc848d0a2005-08-24 21:56:24 -05008705 /* Network configuration changed -- force [re]association */
8706 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8707 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008708 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008709
8710 return 0;
8711}
8712
Jeff Garzikbf794512005-07-31 13:07:26 -04008713static int ipw_wx_set_freq(struct net_device *dev,
8714 struct iw_request_info *info,
8715 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008716{
8717 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008718 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008719 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008720 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008721 u8 channel, flags;
8722 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008723
James Ketrenosb095c382005-08-24 22:04:42 -05008724 if (fwrq->m == 0) {
8725 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008726 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008727 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008728 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008729 return ret;
8730 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008731 /* if setting by freq convert to channel */
8732 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008733 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008734 if (channel == 0)
8735 return -EINVAL;
8736 } else
8737 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008738
Larry Finger1867b112006-02-28 09:48:28 -06008739 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008740 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008741
Liu Hong1fe0adb2005-08-19 09:33:10 -05008742 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008743 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008744 if (i == -1)
8745 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008746
8747 flags = (band == IEEE80211_24GHZ_BAND) ?
8748 geo->bg[i].flags : geo->a[i].flags;
8749 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008750 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8751 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008752 }
8753 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008754
James Ketrenos43f66a62005-03-25 12:31:53 -06008755 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008756 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008757 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008758 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008759 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008760}
8761
Jeff Garzikbf794512005-07-31 13:07:26 -04008762static int ipw_wx_get_freq(struct net_device *dev,
8763 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008764 union iwreq_data *wrqu, char *extra)
8765{
8766 struct ipw_priv *priv = ieee80211_priv(dev);
8767
8768 wrqu->freq.e = 0;
8769
8770 /* If we are associated, trying to associate, or have a statically
8771 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008772 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008773 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008774 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8775 int i;
8776
8777 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8778 BUG_ON(i == -1);
8779 wrqu->freq.e = 1;
8780
8781 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8782 case IEEE80211_52GHZ_BAND:
8783 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8784 break;
8785
8786 case IEEE80211_24GHZ_BAND:
8787 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8788 break;
8789
8790 default:
8791 BUG();
8792 }
8793 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008794 wrqu->freq.m = 0;
8795
Zhu Yi46441512006-01-24 16:37:59 +08008796 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008797 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8798 return 0;
8799}
8800
Jeff Garzikbf794512005-07-31 13:07:26 -04008801static int ipw_wx_set_mode(struct net_device *dev,
8802 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008803 union iwreq_data *wrqu, char *extra)
8804{
8805 struct ipw_priv *priv = ieee80211_priv(dev);
8806 int err = 0;
8807
8808 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8809
James Ketrenos43f66a62005-03-25 12:31:53 -06008810 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008811#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008812 case IW_MODE_MONITOR:
8813#endif
8814 case IW_MODE_ADHOC:
8815 case IW_MODE_INFRA:
8816 break;
8817 case IW_MODE_AUTO:
8818 wrqu->mode = IW_MODE_INFRA;
8819 break;
8820 default:
8821 return -EINVAL;
8822 }
James Ketrenosb095c382005-08-24 22:04:42 -05008823 if (wrqu->mode == priv->ieee->iw_mode)
8824 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008825
Zhu Yi46441512006-01-24 16:37:59 +08008826 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008827
8828 ipw_sw_reset(priv, 0);
8829
James Ketrenosb095c382005-08-24 22:04:42 -05008830#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008831 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008832 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008833
8834 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008835#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008836 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8837#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008838 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008839#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008840#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008841
Jeff Garzikbf794512005-07-31 13:07:26 -04008842 /* Free the existing firmware and reset the fw_loaded
Nick Andrew877d0312009-01-26 11:06:57 +01008843 * flag so ipw_load() will bring in the new firmware */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008844 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008845
8846 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008847
James Ketrenosc848d0a2005-08-24 21:56:24 -05008848 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008849 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008850 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008851}
8852
Jeff Garzikbf794512005-07-31 13:07:26 -04008853static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008854 struct iw_request_info *info,
8855 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008856{
8857 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008858 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008859 wrqu->mode = priv->ieee->iw_mode;
8860 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008861 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008862 return 0;
8863}
8864
James Ketrenos43f66a62005-03-25 12:31:53 -06008865/* Values are in microsecond */
8866static const s32 timeout_duration[] = {
8867 350000,
8868 250000,
8869 75000,
8870 37000,
8871 25000,
8872};
8873
8874static const s32 period_duration[] = {
8875 400000,
8876 700000,
8877 1000000,
8878 1000000,
8879 1000000
8880};
8881
Jeff Garzikbf794512005-07-31 13:07:26 -04008882static int ipw_wx_get_range(struct net_device *dev,
8883 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008884 union iwreq_data *wrqu, char *extra)
8885{
8886 struct ipw_priv *priv = ieee80211_priv(dev);
8887 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008888 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008889 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008890
8891 wrqu->data.length = sizeof(*range);
8892 memset(range, 0, sizeof(*range));
8893
8894 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008895 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008896
8897 range->max_qual.qual = 100;
8898 /* TODO: Find real max RSSI and stick here */
8899 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008900 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008901 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008902
8903 range->avg_qual.qual = 70;
8904 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008905 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008906 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008907 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008908 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008909 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008910
Jeff Garzikbf794512005-07-31 13:07:26 -04008911 for (i = 0; i < range->num_bitrates; i++)
8912 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008913 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008914
James Ketrenos43f66a62005-03-25 12:31:53 -06008915 range->max_rts = DEFAULT_RTS_THRESHOLD;
8916 range->min_frag = MIN_FRAG_THRESHOLD;
8917 range->max_frag = MAX_FRAG_THRESHOLD;
8918
8919 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008920 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008921 range->num_encoding_sizes = 2;
8922 range->max_encoding_tokens = WEP_KEYS;
8923
8924 /* Set the Wireless Extension versions */
8925 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008926 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008927
James Ketrenosb095c382005-08-24 22:04:42 -05008928 i = 0;
8929 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008930 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8931 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8932 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8933 continue;
8934
James Ketrenosb095c382005-08-24 22:04:42 -05008935 range->freq[i].i = geo->bg[j].channel;
8936 range->freq[i].m = geo->bg[j].freq * 100000;
8937 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008938 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008939 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008940 }
James Ketrenosb095c382005-08-24 22:04:42 -05008941
8942 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008943 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8944 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8945 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8946 continue;
8947
James Ketrenosb095c382005-08-24 22:04:42 -05008948 range->freq[i].i = geo->a[j].channel;
8949 range->freq[i].m = geo->a[j].freq * 100000;
8950 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008951 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008952 }
8953 }
8954
8955 range->num_channels = i;
8956 range->num_frequency = i;
8957
Zhu Yi46441512006-01-24 16:37:59 +08008958 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008959
8960 /* Event capability (kernel + driver) */
8961 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8962 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008963 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8964 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008965 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008966
Dan Williamsf1b50862006-01-30 13:58:56 -05008967 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8968 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8969
Dan Williams374fdfb2007-12-12 10:25:07 -05008970 range->scan_capa = IW_SCAN_CAPA_ESSID | IW_SCAN_CAPA_TYPE;
8971
James Ketrenos43f66a62005-03-25 12:31:53 -06008972 IPW_DEBUG_WX("GET Range\n");
8973 return 0;
8974}
8975
Jeff Garzikbf794512005-07-31 13:07:26 -04008976static int ipw_wx_set_wap(struct net_device *dev,
8977 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008978 union iwreq_data *wrqu, char *extra)
8979{
8980 struct ipw_priv *priv = ieee80211_priv(dev);
8981
8982 static const unsigned char any[] = {
8983 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8984 };
8985 static const unsigned char off[] = {
8986 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8987 };
8988
Jeff Garzikbf794512005-07-31 13:07:26 -04008989 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008990 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008991 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008992 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8993 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8994 /* we disable mandatory BSSID association */
8995 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8996 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008997 IPW_DEBUG_ASSOC("Attempting to associate with new "
8998 "parameters.\n");
8999 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08009000 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009001 return 0;
9002 }
9003
9004 priv->config |= CFG_STATIC_BSSID;
9005 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
9006 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009007 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009008 return 0;
9009 }
9010
Johannes Berge1749612008-10-27 15:59:26 -07009011 IPW_DEBUG_WX("Setting mandatory BSSID to %pM\n",
9012 wrqu->ap_addr.sa_data);
James Ketrenos43f66a62005-03-25 12:31:53 -06009013
9014 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
9015
James Ketrenosc848d0a2005-08-24 21:56:24 -05009016 /* Network configuration changed -- force [re]association */
9017 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
9018 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009019 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009020
Zhu Yi46441512006-01-24 16:37:59 +08009021 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009022 return 0;
9023}
9024
Jeff Garzikbf794512005-07-31 13:07:26 -04009025static int ipw_wx_get_wap(struct net_device *dev,
9026 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009027 union iwreq_data *wrqu, char *extra)
9028{
9029 struct ipw_priv *priv = ieee80211_priv(dev);
Joe Perches0795af52007-10-03 17:59:30 -07009030
James Ketrenos43f66a62005-03-25 12:31:53 -06009031 /* If we are associated, trying to associate, or have a statically
9032 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009033 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009034 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06009035 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9036 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009037 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06009038 } else
9039 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
9040
Johannes Berge1749612008-10-27 15:59:26 -07009041 IPW_DEBUG_WX("Getting WAP BSSID: %pM\n",
9042 wrqu->ap_addr.sa_data);
Zhu Yi46441512006-01-24 16:37:59 +08009043 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009044 return 0;
9045}
9046
Jeff Garzikbf794512005-07-31 13:07:26 -04009047static int ipw_wx_set_essid(struct net_device *dev,
9048 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009049 union iwreq_data *wrqu, char *extra)
9050{
9051 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08009052 int length;
John W. Linville9387b7c2008-09-30 20:59:05 -04009053 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06009054
Zhu Yiab644b02006-08-21 11:37:13 +08009055 mutex_lock(&priv->mutex);
9056
9057 if (!wrqu->essid.flags)
9058 {
9059 IPW_DEBUG_WX("Setting ESSID to ANY\n");
9060 ipw_disassociate(priv);
9061 priv->config &= ~CFG_STATIC_ESSID;
9062 ipw_associate(priv);
9063 mutex_unlock(&priv->mutex);
9064 return 0;
9065 }
9066
Zhu Yia9f0d422006-08-21 11:37:26 +08009067 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06009068
9069 priv->config |= CFG_STATIC_ESSID;
9070
Zhu Yia9f0d422006-08-21 11:37:26 +08009071 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
9072 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009073 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009074 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009075 return 0;
9076 }
9077
John W. Linville9387b7c2008-09-30 20:59:05 -04009078 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n",
9079 print_ssid(ssid, extra, length), length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009080
9081 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08009082 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04009083
James Ketrenosc848d0a2005-08-24 21:56:24 -05009084 /* Network configuration changed -- force [re]association */
9085 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
9086 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06009087 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009088
Zhu Yi46441512006-01-24 16:37:59 +08009089 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009090 return 0;
9091}
9092
Jeff Garzikbf794512005-07-31 13:07:26 -04009093static int ipw_wx_get_essid(struct net_device *dev,
9094 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009095 union iwreq_data *wrqu, char *extra)
9096{
9097 struct ipw_priv *priv = ieee80211_priv(dev);
John W. Linville9387b7c2008-09-30 20:59:05 -04009098 DECLARE_SSID_BUF(ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06009099
9100 /* If we are associated, trying to associate, or have a statically
9101 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08009102 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009103 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04009104 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
9105 IPW_DEBUG_WX("Getting essid: '%s'\n",
John W. Linville9387b7c2008-09-30 20:59:05 -04009106 print_ssid(ssid, priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04009107 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06009108 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009109 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009110 } else {
9111 IPW_DEBUG_WX("Getting essid: ANY\n");
9112 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009113 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06009114 }
Zhu Yi46441512006-01-24 16:37:59 +08009115 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009116 return 0;
9117}
9118
Jeff Garzikbf794512005-07-31 13:07:26 -04009119static int ipw_wx_set_nick(struct net_device *dev,
9120 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009121 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009122{
James Ketrenos43f66a62005-03-25 12:31:53 -06009123 struct ipw_priv *priv = ieee80211_priv(dev);
9124
9125 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
9126 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
9127 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08009128 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009129 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06009130 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009131 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06009132 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08009133 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009134 return 0;
9135
9136}
9137
Jeff Garzikbf794512005-07-31 13:07:26 -04009138static int ipw_wx_get_nick(struct net_device *dev,
9139 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009140 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009141{
James Ketrenos43f66a62005-03-25 12:31:53 -06009142 struct ipw_priv *priv = ieee80211_priv(dev);
9143 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08009144 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009145 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06009146 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009147 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08009148 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009149 return 0;
9150}
9151
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009152static int ipw_wx_set_sens(struct net_device *dev,
9153 struct iw_request_info *info,
9154 union iwreq_data *wrqu, char *extra)
9155{
9156 struct ipw_priv *priv = ieee80211_priv(dev);
9157 int err = 0;
9158
9159 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
9160 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
9161 mutex_lock(&priv->mutex);
9162
9163 if (wrqu->sens.fixed == 0)
9164 {
9165 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
9166 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
9167 goto out;
9168 }
9169 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
9170 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
9171 err = -EINVAL;
9172 goto out;
9173 }
9174
9175 priv->roaming_threshold = wrqu->sens.value;
9176 priv->disassociate_threshold = 3*wrqu->sens.value;
9177 out:
9178 mutex_unlock(&priv->mutex);
9179 return err;
9180}
9181
9182static int ipw_wx_get_sens(struct net_device *dev,
9183 struct iw_request_info *info,
9184 union iwreq_data *wrqu, char *extra)
9185{
9186 struct ipw_priv *priv = ieee80211_priv(dev);
9187 mutex_lock(&priv->mutex);
9188 wrqu->sens.fixed = 1;
9189 wrqu->sens.value = priv->roaming_threshold;
9190 mutex_unlock(&priv->mutex);
9191
9192 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9193 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9194
9195 return 0;
9196}
9197
James Ketrenos43f66a62005-03-25 12:31:53 -06009198static int ipw_wx_set_rate(struct net_device *dev,
9199 struct iw_request_info *info,
9200 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009201{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009202 /* TODO: We should use semaphores or locks for access to priv */
9203 struct ipw_priv *priv = ieee80211_priv(dev);
9204 u32 target_rate = wrqu->bitrate.value;
9205 u32 fixed, mask;
9206
9207 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9208 /* value = X, fixed = 1 means only rate X */
9209 /* value = X, fixed = 0 means all rates lower equal X */
9210
9211 if (target_rate == -1) {
9212 fixed = 0;
9213 mask = IEEE80211_DEFAULT_RATES_MASK;
9214 /* Now we should reassociate */
9215 goto apply;
9216 }
9217
9218 mask = 0;
9219 fixed = wrqu->bitrate.fixed;
9220
9221 if (target_rate == 1000000 || !fixed)
9222 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9223 if (target_rate == 1000000)
9224 goto apply;
9225
9226 if (target_rate == 2000000 || !fixed)
9227 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9228 if (target_rate == 2000000)
9229 goto apply;
9230
9231 if (target_rate == 5500000 || !fixed)
9232 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9233 if (target_rate == 5500000)
9234 goto apply;
9235
9236 if (target_rate == 6000000 || !fixed)
9237 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9238 if (target_rate == 6000000)
9239 goto apply;
9240
9241 if (target_rate == 9000000 || !fixed)
9242 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9243 if (target_rate == 9000000)
9244 goto apply;
9245
9246 if (target_rate == 11000000 || !fixed)
9247 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9248 if (target_rate == 11000000)
9249 goto apply;
9250
9251 if (target_rate == 12000000 || !fixed)
9252 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9253 if (target_rate == 12000000)
9254 goto apply;
9255
9256 if (target_rate == 18000000 || !fixed)
9257 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9258 if (target_rate == 18000000)
9259 goto apply;
9260
9261 if (target_rate == 24000000 || !fixed)
9262 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9263 if (target_rate == 24000000)
9264 goto apply;
9265
9266 if (target_rate == 36000000 || !fixed)
9267 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9268 if (target_rate == 36000000)
9269 goto apply;
9270
9271 if (target_rate == 48000000 || !fixed)
9272 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9273 if (target_rate == 48000000)
9274 goto apply;
9275
9276 if (target_rate == 54000000 || !fixed)
9277 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9278 if (target_rate == 54000000)
9279 goto apply;
9280
9281 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9282 return -EINVAL;
9283
9284 apply:
9285 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9286 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009287 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009288 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009289 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009290 ipw_set_fixed_rate(priv, priv->ieee->mode);
9291 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009292 priv->config |= CFG_FIXED_RATE;
9293
James Ketrenosc848d0a2005-08-24 21:56:24 -05009294 if (priv->rates_mask == mask) {
9295 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009296 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009297 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009298 }
9299
James Ketrenosc848d0a2005-08-24 21:56:24 -05009300 priv->rates_mask = mask;
9301
9302 /* Network configuration changed -- force [re]association */
9303 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9304 if (!ipw_disassociate(priv))
9305 ipw_associate(priv);
9306
Zhu Yi46441512006-01-24 16:37:59 +08009307 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009308 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009309}
9310
Jeff Garzikbf794512005-07-31 13:07:26 -04009311static int ipw_wx_get_rate(struct net_device *dev,
9312 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009313 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009314{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009315 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009316 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009317 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009318 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009319 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009320 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9321 return 0;
9322}
9323
Jeff Garzikbf794512005-07-31 13:07:26 -04009324static int ipw_wx_set_rts(struct net_device *dev,
9325 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009326 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009327{
James Ketrenos43f66a62005-03-25 12:31:53 -06009328 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009329 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009330 if (wrqu->rts.disabled || !wrqu->rts.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009331 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9332 else {
9333 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009334 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009335 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009336 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009337 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009338 priv->rts_threshold = wrqu->rts.value;
9339 }
9340
9341 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009342 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009343 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9344 return 0;
9345}
9346
Jeff Garzikbf794512005-07-31 13:07:26 -04009347static int ipw_wx_get_rts(struct net_device *dev,
9348 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009349 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009350{
James Ketrenos43f66a62005-03-25 12:31:53 -06009351 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009352 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009353 wrqu->rts.value = priv->rts_threshold;
9354 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009355 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009356 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009357 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9358 return 0;
9359}
9360
Jeff Garzikbf794512005-07-31 13:07:26 -04009361static int ipw_wx_set_txpow(struct net_device *dev,
9362 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009363 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009364{
James Ketrenos43f66a62005-03-25 12:31:53 -06009365 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009366 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009367
Zhu Yi46441512006-01-24 16:37:59 +08009368 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009369 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009370 err = -EINPROGRESS;
9371 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009372 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009373
James Ketrenosb095c382005-08-24 22:04:42 -05009374 if (!wrqu->power.fixed)
9375 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009376
James Ketrenosc848d0a2005-08-24 21:56:24 -05009377 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009378 err = -EINVAL;
9379 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009380 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009381
James Ketrenosb095c382005-08-24 22:04:42 -05009382 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009383 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009384 err = -EINVAL;
9385 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009386 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009387
9388 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009389 err = ipw_set_tx_power(priv);
9390 out:
Zhu Yi46441512006-01-24 16:37:59 +08009391 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009392 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009393}
9394
Jeff Garzikbf794512005-07-31 13:07:26 -04009395static int ipw_wx_get_txpow(struct net_device *dev,
9396 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009397 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009398{
James Ketrenos43f66a62005-03-25 12:31:53 -06009399 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009400 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009401 wrqu->power.value = priv->tx_power;
9402 wrqu->power.fixed = 1;
9403 wrqu->power.flags = IW_TXPOW_DBM;
9404 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009405 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009406
Jeff Garzikbf794512005-07-31 13:07:26 -04009407 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009408 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009409
9410 return 0;
9411}
9412
Jeff Garzikbf794512005-07-31 13:07:26 -04009413static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009414 struct iw_request_info *info,
9415 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009416{
9417 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009418 mutex_lock(&priv->mutex);
Zhu Yiea8862d2007-01-11 17:32:54 +08009419 if (wrqu->frag.disabled || !wrqu->frag.fixed)
James Ketrenos43f66a62005-03-25 12:31:53 -06009420 priv->ieee->fts = DEFAULT_FTS;
9421 else {
9422 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009423 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009424 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009425 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009426 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009427
James Ketrenos43f66a62005-03-25 12:31:53 -06009428 priv->ieee->fts = wrqu->frag.value & ~0x1;
9429 }
9430
9431 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009432 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009433 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9434 return 0;
9435}
9436
Jeff Garzikbf794512005-07-31 13:07:26 -04009437static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009438 struct iw_request_info *info,
9439 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009440{
9441 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009442 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009443 wrqu->frag.value = priv->ieee->fts;
9444 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009445 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009446 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009447 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9448
9449 return 0;
9450}
9451
Jeff Garzikbf794512005-07-31 13:07:26 -04009452static int ipw_wx_set_retry(struct net_device *dev,
9453 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009454 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009455{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009456 struct ipw_priv *priv = ieee80211_priv(dev);
9457
9458 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9459 return -EINVAL;
9460
9461 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9462 return 0;
9463
Zhu Yid5f7ac22006-08-21 11:38:17 +08009464 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009465 return -EINVAL;
9466
Zhu Yi46441512006-01-24 16:37:59 +08009467 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009468 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009469 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009470 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009471 priv->long_retry_limit = (u8) wrqu->retry.value;
9472 else {
9473 priv->short_retry_limit = (u8) wrqu->retry.value;
9474 priv->long_retry_limit = (u8) wrqu->retry.value;
9475 }
9476
9477 ipw_send_retry_limit(priv, priv->short_retry_limit,
9478 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009479 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009480 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9481 priv->short_retry_limit, priv->long_retry_limit);
9482 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009483}
9484
Jeff Garzikbf794512005-07-31 13:07:26 -04009485static int ipw_wx_get_retry(struct net_device *dev,
9486 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009487 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009488{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009489 struct ipw_priv *priv = ieee80211_priv(dev);
9490
Zhu Yi46441512006-01-24 16:37:59 +08009491 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009492 wrqu->retry.disabled = 0;
9493
9494 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009495 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009496 return -EINVAL;
9497 }
9498
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009499 if (wrqu->retry.flags & IW_RETRY_LONG) {
9500 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009501 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009502 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9503 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009504 wrqu->retry.value = priv->short_retry_limit;
9505 } else {
9506 wrqu->retry.flags = IW_RETRY_LIMIT;
9507 wrqu->retry.value = priv->short_retry_limit;
9508 }
Zhu Yi46441512006-01-24 16:37:59 +08009509 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009510
9511 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9512
9513 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009514}
9515
Jeff Garzikbf794512005-07-31 13:07:26 -04009516static int ipw_wx_set_scan(struct net_device *dev,
9517 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009518 union iwreq_data *wrqu, char *extra)
9519{
9520 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009521 struct iw_scan_req *req = (struct iw_scan_req *)extra;
Dan Williamsea177302008-06-02 17:51:23 -04009522 struct delayed_work *work = NULL;
Zhu Yi094c4d22006-08-21 11:39:03 +08009523
Dan Williams0b531672007-10-09 13:55:24 -04009524 mutex_lock(&priv->mutex);
Dan Williamsea177302008-06-02 17:51:23 -04009525
Dan Williams0b531672007-10-09 13:55:24 -04009526 priv->user_requested_scan = 1;
Dan Williams0b531672007-10-09 13:55:24 -04009527
Zhu Yi094c4d22006-08-21 11:39:03 +08009528 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009529 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
Dan Williamsea177302008-06-02 17:51:23 -04009530 int len = min((int)req->essid_len,
9531 (int)sizeof(priv->direct_scan_ssid));
9532 memcpy(priv->direct_scan_ssid, req->essid, len);
9533 priv->direct_scan_ssid_len = len;
9534 work = &priv->request_direct_scan;
9535 } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9536 work = &priv->request_passive_scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009537 }
Dan Williamsea177302008-06-02 17:51:23 -04009538 } else {
9539 /* Normal active broadcast scan */
9540 work = &priv->request_scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009541 }
James Ketrenos8935f392005-10-05 15:59:08 -05009542
Dan Williamsea177302008-06-02 17:51:23 -04009543 mutex_unlock(&priv->mutex);
9544
James Ketrenos43f66a62005-03-25 12:31:53 -06009545 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009546
Dan Williamsea177302008-06-02 17:51:23 -04009547 queue_delayed_work(priv->workqueue, work, 0);
James Ketrenosb095c382005-08-24 22:04:42 -05009548
James Ketrenos43f66a62005-03-25 12:31:53 -06009549 return 0;
9550}
9551
Jeff Garzikbf794512005-07-31 13:07:26 -04009552static int ipw_wx_get_scan(struct net_device *dev,
9553 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009554 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009555{
James Ketrenos43f66a62005-03-25 12:31:53 -06009556 struct ipw_priv *priv = ieee80211_priv(dev);
9557 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9558}
9559
Jeff Garzikbf794512005-07-31 13:07:26 -04009560static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009561 struct iw_request_info *info,
9562 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009563{
9564 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009565 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009566 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009567
Zhu Yi46441512006-01-24 16:37:59 +08009568 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009569 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009570
Hong Liucaeff812005-08-05 17:25:50 +08009571 /* In IBSS mode, we need to notify the firmware to update
9572 * the beacon info after we changed the capability. */
9573 if (cap != priv->capability &&
9574 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9575 priv->status & STATUS_ASSOCIATED)
9576 ipw_disassociate(priv);
9577
Zhu Yi46441512006-01-24 16:37:59 +08009578 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009579 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009580}
9581
Jeff Garzikbf794512005-07-31 13:07:26 -04009582static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009583 struct iw_request_info *info,
9584 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009585{
9586 struct ipw_priv *priv = ieee80211_priv(dev);
9587 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9588}
9589
Jeff Garzikbf794512005-07-31 13:07:26 -04009590static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009591 struct iw_request_info *info,
9592 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009593{
9594 struct ipw_priv *priv = ieee80211_priv(dev);
9595 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009596 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009597 if (wrqu->power.disabled) {
9598 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9599 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9600 if (err) {
9601 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009602 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009603 return err;
9604 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009605 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009606 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009607 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009608 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009609
9610 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009611 case IW_POWER_ON: /* If not specified */
9612 case IW_POWER_MODE: /* If set all mask */
Jean Delvarec03983a2007-10-19 23:22:55 +02009613 case IW_POWER_ALL_R: /* If explicitly state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009614 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009615 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009616 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9617 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009618 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009619 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009620 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009621
James Ketrenos43f66a62005-03-25 12:31:53 -06009622 /* If the user hasn't specified a power management mode yet, default
9623 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009624 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009625 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009626 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009627 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
Zhu Yi4e157f02007-07-12 16:09:32 +08009628
James Ketrenos43f66a62005-03-25 12:31:53 -06009629 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9630 if (err) {
9631 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009632 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009633 return err;
9634 }
9635
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009636 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009637 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009638 return 0;
9639}
9640
Jeff Garzikbf794512005-07-31 13:07:26 -04009641static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009642 struct iw_request_info *info,
9643 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009644{
9645 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009646 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009647 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009648 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009649 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009650 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009651
Zhu Yi46441512006-01-24 16:37:59 +08009652 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009653 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009654
James Ketrenos43f66a62005-03-25 12:31:53 -06009655 return 0;
9656}
9657
Jeff Garzikbf794512005-07-31 13:07:26 -04009658static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009659 struct iw_request_info *info,
9660 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009661{
9662 struct ipw_priv *priv = ieee80211_priv(dev);
9663 int mode = *(int *)extra;
9664 int err;
Zhu Yi4e157f02007-07-12 16:09:32 +08009665
Zhu Yi46441512006-01-24 16:37:59 +08009666 mutex_lock(&priv->mutex);
Zhu Yi4e157f02007-07-12 16:09:32 +08009667 if ((mode < 1) || (mode > IPW_POWER_LIMIT))
James Ketrenos43f66a62005-03-25 12:31:53 -06009668 mode = IPW_POWER_AC;
Jeff Garzikbf794512005-07-31 13:07:26 -04009669
Zhu Yi4e157f02007-07-12 16:09:32 +08009670 if (IPW_POWER_LEVEL(priv->power_mode) != mode) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009671 err = ipw_send_power_mode(priv, mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009672 if (err) {
9673 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009674 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009675 return err;
9676 }
Zhu Yi4e157f02007-07-12 16:09:32 +08009677 priv->power_mode = IPW_POWER_ENABLED | mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06009678 }
Zhu Yi46441512006-01-24 16:37:59 +08009679 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009680 return 0;
9681}
9682
9683#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009684static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009685 struct iw_request_info *info,
9686 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009687{
9688 struct ipw_priv *priv = ieee80211_priv(dev);
9689 int level = IPW_POWER_LEVEL(priv->power_mode);
9690 char *p = extra;
9691
9692 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9693
9694 switch (level) {
9695 case IPW_POWER_AC:
9696 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9697 break;
9698 case IPW_POWER_BATTERY:
9699 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9700 break;
9701 default:
9702 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009703 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009704 timeout_duration[level - 1] / 1000,
9705 period_duration[level - 1] / 1000);
9706 }
9707
9708 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009709 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009710
9711 wrqu->data.length = p - extra + 1;
9712
9713 return 0;
9714}
9715
9716static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009717 struct iw_request_info *info,
9718 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009719{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009720 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009721 int mode = *(int *)extra;
9722 u8 band = 0, modulation = 0;
9723
9724 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009725 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009726 return -EINVAL;
9727 }
Zhu Yi46441512006-01-24 16:37:59 +08009728 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009729 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009730 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009731 if (mode & IEEE_A) {
9732 band |= IEEE80211_52GHZ_BAND;
9733 modulation |= IEEE80211_OFDM_MODULATION;
9734 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009735 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009736 } else {
9737 if (mode & IEEE_A) {
9738 IPW_WARNING("Attempt to set 2200BG into "
9739 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009740 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009741 return -EINVAL;
9742 }
9743
James Ketrenosa33a1982005-09-14 14:28:59 -05009744 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009745 }
9746
9747 if (mode & IEEE_B) {
9748 band |= IEEE80211_24GHZ_BAND;
9749 modulation |= IEEE80211_CCK_MODULATION;
9750 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009751 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009752
James Ketrenos43f66a62005-03-25 12:31:53 -06009753 if (mode & IEEE_G) {
9754 band |= IEEE80211_24GHZ_BAND;
9755 modulation |= IEEE80211_OFDM_MODULATION;
9756 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009757 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009758
9759 priv->ieee->mode = mode;
9760 priv->ieee->freq_band = band;
9761 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009762 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009763
James Ketrenosc848d0a2005-08-24 21:56:24 -05009764 /* Network configuration changed -- force [re]association */
9765 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9766 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009767 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009768 ipw_associate(priv);
9769 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009770
James Ketrenosa613bff2005-08-24 21:43:11 -05009771 /* Update the band LEDs */
9772 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009773
Jeff Garzikbf794512005-07-31 13:07:26 -04009774 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009775 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009776 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009777 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009778 return 0;
9779}
9780
9781static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009782 struct iw_request_info *info,
9783 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009784{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009785 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009786 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009787 switch (priv->ieee->mode) {
9788 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009789 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9790 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009791 case IEEE_B:
9792 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9793 break;
9794 case IEEE_A | IEEE_B:
9795 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9796 break;
9797 case IEEE_G:
9798 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9799 break;
9800 case IEEE_A | IEEE_G:
9801 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9802 break;
9803 case IEEE_B | IEEE_G:
9804 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9805 break;
9806 case IEEE_A | IEEE_B | IEEE_G:
9807 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9808 break;
9809 default:
9810 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009811 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009812 }
9813
James Ketrenos43f66a62005-03-25 12:31:53 -06009814 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9815
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009816 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009817 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009818
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009819 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009820}
9821
James Ketrenosea2b26e2005-08-24 21:25:16 -05009822static int ipw_wx_set_preamble(struct net_device *dev,
9823 struct iw_request_info *info,
9824 union iwreq_data *wrqu, char *extra)
9825{
9826 struct ipw_priv *priv = ieee80211_priv(dev);
9827 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009828 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009829 /* Switching from SHORT -> LONG requires a disassociation */
9830 if (mode == 1) {
9831 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9832 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009833
9834 /* Network configuration changed -- force [re]association */
9835 IPW_DEBUG_ASSOC
9836 ("[re]association triggered due to preamble change.\n");
9837 if (!ipw_disassociate(priv))
9838 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009839 }
9840 goto done;
9841 }
9842
9843 if (mode == 0) {
9844 priv->config &= ~CFG_PREAMBLE_LONG;
9845 goto done;
9846 }
Zhu Yi46441512006-01-24 16:37:59 +08009847 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009848 return -EINVAL;
9849
9850 done:
Zhu Yi46441512006-01-24 16:37:59 +08009851 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009852 return 0;
9853}
9854
9855static int ipw_wx_get_preamble(struct net_device *dev,
9856 struct iw_request_info *info,
9857 union iwreq_data *wrqu, char *extra)
9858{
9859 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009860 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009861 if (priv->config & CFG_PREAMBLE_LONG)
9862 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9863 else
9864 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009865 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009866 return 0;
9867}
9868
James Ketrenosb095c382005-08-24 22:04:42 -05009869#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009870static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009871 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009872 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009873{
James Ketrenos43f66a62005-03-25 12:31:53 -06009874 struct ipw_priv *priv = ieee80211_priv(dev);
9875 int *parms = (int *)extra;
9876 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009877 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009878 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009879 if (enable) {
9880 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009881#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009882 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9883#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009884 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009885#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009886 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009887 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009888
James Ketrenos43f66a62005-03-25 12:31:53 -06009889 ipw_set_channel(priv, parms[1]);
9890 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009891 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009892 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009893 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009894 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009895 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009896 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009897 }
Zhu Yi46441512006-01-24 16:37:59 +08009898 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009899 return 0;
9900}
9901
Pavel Machek67fd6b42006-07-11 15:34:05 +02009902#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009903
Jeff Garzikbf794512005-07-31 13:07:26 -04009904static int ipw_wx_reset(struct net_device *dev,
9905 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009906 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009907{
James Ketrenos43f66a62005-03-25 12:31:53 -06009908 struct ipw_priv *priv = ieee80211_priv(dev);
9909 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009910 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009911 return 0;
9912}
James Ketrenosb095c382005-08-24 22:04:42 -05009913
James Ketrenosb095c382005-08-24 22:04:42 -05009914static int ipw_wx_sw_reset(struct net_device *dev,
9915 struct iw_request_info *info,
9916 union iwreq_data *wrqu, char *extra)
9917{
9918 struct ipw_priv *priv = ieee80211_priv(dev);
9919 union iwreq_data wrqu_sec = {
9920 .encoding = {
9921 .flags = IW_ENCODE_DISABLED,
9922 },
9923 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009924 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009925
9926 IPW_DEBUG_WX("SW_RESET\n");
9927
Zhu Yi46441512006-01-24 16:37:59 +08009928 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009929
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009930 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009931 if (!ret) {
9932 free_firmware();
9933 ipw_adapter_restart(priv);
9934 }
James Ketrenosb095c382005-08-24 22:04:42 -05009935
9936 /* The SW reset bit might have been toggled on by the 'disable'
9937 * module parameter, so take appropriate action */
9938 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9939
Zhu Yi46441512006-01-24 16:37:59 +08009940 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009941 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009942 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009943
9944 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9945 /* Configuration likely changed -- force [re]association */
9946 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9947 "reset.\n");
9948 if (!ipw_disassociate(priv))
9949 ipw_associate(priv);
9950 }
9951
Zhu Yi46441512006-01-24 16:37:59 +08009952 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009953
9954 return 0;
9955}
James Ketrenos43f66a62005-03-25 12:31:53 -06009956
9957/* Rebase the WE IOCTLs to zero for the handler array */
9958#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009959static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009960 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9961 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9962 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9963 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9964 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009965 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9966 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009967 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9968 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9969 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9970 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9971 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9972 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9973 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9974 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9975 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9976 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9977 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9978 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9979 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9980 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9981 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9982 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9983 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9984 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9985 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9986 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9987 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9988 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9989 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009990 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9991 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9992 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9993 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009994 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9995 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
9996 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
9997 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
9998 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
9999 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
10000 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -060010001};
10002
James Ketrenosb095c382005-08-24 22:04:42 -050010003enum {
10004 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
10005 IPW_PRIV_GET_POWER,
10006 IPW_PRIV_SET_MODE,
10007 IPW_PRIV_GET_MODE,
10008 IPW_PRIV_SET_PREAMBLE,
10009 IPW_PRIV_GET_PREAMBLE,
10010 IPW_PRIV_RESET,
10011 IPW_PRIV_SW_RESET,
10012#ifdef CONFIG_IPW2200_MONITOR
10013 IPW_PRIV_SET_MONITOR,
10014#endif
10015};
James Ketrenos43f66a62005-03-25 12:31:53 -060010016
Jeff Garzikbf794512005-07-31 13:07:26 -040010017static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -060010018 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010019 .cmd = IPW_PRIV_SET_POWER,
10020 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10021 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010022 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010023 .cmd = IPW_PRIV_GET_POWER,
10024 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10025 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010026 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010027 .cmd = IPW_PRIV_SET_MODE,
10028 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10029 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010030 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010031 .cmd = IPW_PRIV_GET_MODE,
10032 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
10033 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010034 {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010035 .cmd = IPW_PRIV_SET_PREAMBLE,
10036 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
10037 .name = "set_preamble"},
10038 {
10039 .cmd = IPW_PRIV_GET_PREAMBLE,
10040 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
10041 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -060010042 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010043 IPW_PRIV_RESET,
10044 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -050010045 {
10046 IPW_PRIV_SW_RESET,
10047 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
10048#ifdef CONFIG_IPW2200_MONITOR
10049 {
10050 IPW_PRIV_SET_MONITOR,
10051 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
10052#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -060010053};
10054
10055static iw_handler ipw_priv_handler[] = {
10056 ipw_wx_set_powermode,
10057 ipw_wx_get_powermode,
10058 ipw_wx_set_wireless_mode,
10059 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -050010060 ipw_wx_set_preamble,
10061 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -040010062 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -050010063 ipw_wx_sw_reset,
10064#ifdef CONFIG_IPW2200_MONITOR
10065 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -060010066#endif
10067};
10068
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010069static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010070 .standard = ipw_wx_handlers,
10071 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
10072 .num_private = ARRAY_SIZE(ipw_priv_handler),
10073 .num_private_args = ARRAY_SIZE(ipw_priv_args),
10074 .private = ipw_priv_handler,
10075 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000010076 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -060010077};
10078
James Ketrenos43f66a62005-03-25 12:31:53 -060010079/*
10080 * Get wireless statistics.
10081 * Called by /proc/net/wireless
10082 * Also called by SIOCGIWSTATS
10083 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010084static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -060010085{
10086 struct ipw_priv *priv = ieee80211_priv(dev);
10087 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010088
James Ketrenos43f66a62005-03-25 12:31:53 -060010089 wstats = &priv->wstats;
10090
James Ketrenosea2b26e2005-08-24 21:25:16 -050010091 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -050010092 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -060010093 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
10094 * and associated; if not associcated, the values are all meaningless
10095 * anyway, so set them all to NULL and INVALID */
10096 if (!(priv->status & STATUS_ASSOCIATED)) {
10097 wstats->miss.beacon = 0;
10098 wstats->discard.retries = 0;
10099 wstats->qual.qual = 0;
10100 wstats->qual.level = 0;
10101 wstats->qual.noise = 0;
10102 wstats->qual.updated = 7;
10103 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010104 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -060010105 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -040010106 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010107
10108 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +080010109 wstats->qual.level = priv->exp_avg_rssi;
10110 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -060010111 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +080010112 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010113
10114 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
10115 wstats->discard.retries = priv->last_tx_failures;
10116 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -040010117
James Ketrenos43f66a62005-03-25 12:31:53 -060010118/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
10119 goto fail_get_ordinal;
10120 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -040010121
James Ketrenos43f66a62005-03-25 12:31:53 -060010122 return wstats;
10123}
10124
James Ketrenos43f66a62005-03-25 12:31:53 -060010125/* net device stuff */
10126
Arjan van de Ven858119e2006-01-14 13:20:43 -080010127static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -060010128{
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010129 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +080010130 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010131 sys_config->answer_broadcast_ssid_probe = 0;
10132 sys_config->accept_all_data_frames = 0;
10133 sys_config->accept_non_directed_frames = 1;
10134 sys_config->exclude_unicast_unencrypted = 0;
10135 sys_config->disable_unicast_decryption = 1;
10136 sys_config->exclude_multicast_unencrypted = 0;
10137 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010138 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10139 antenna = CFG_SYS_ANTENNA_BOTH;
10140 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010141 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010142 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010143 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010144 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010145 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010146 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010147}
10148
10149static int ipw_net_open(struct net_device *dev)
10150{
James Ketrenos43f66a62005-03-25 12:31:53 -060010151 IPW_DEBUG_INFO("dev->open\n");
David S. Miller521c4d92008-07-22 18:32:47 -070010152 netif_start_queue(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -060010153 return 0;
10154}
10155
10156static int ipw_net_stop(struct net_device *dev)
10157{
10158 IPW_DEBUG_INFO("dev->close\n");
10159 netif_stop_queue(dev);
10160 return 0;
10161}
10162
10163/*
10164todo:
10165
10166modify to send one tfd per fragment instead of using chunking. otherwise
10167we need to heavily modify the ieee80211_skb_to_txb.
10168*/
10169
Arjan van de Ven858119e2006-01-14 13:20:43 -080010170static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010171 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010172{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010173 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010174 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010175 int i = 0;
10176 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010177#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010178 int tx_id = ipw_get_tx_queue_number(priv, pri);
10179 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10180#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010181 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010182#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010183 struct clx2_queue *q = &txq->q;
10184 u8 id, hdr_len, unicast;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010185 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010186
Zhu Yib8ddafd2008-11-27 13:42:20 +080010187 if (!(priv->status & STATUS_ASSOCIATED))
10188 goto drop;
10189
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010190 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010191 switch (priv->ieee->iw_mode) {
10192 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010193 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010194 id = ipw_find_station(priv, hdr->addr1);
10195 if (id == IPW_INVALID_STATION) {
10196 id = ipw_add_station(priv, hdr->addr1);
10197 if (id == IPW_INVALID_STATION) {
10198 IPW_WARNING("Attempt to send data to "
Johannes Berge1749612008-10-27 15:59:26 -070010199 "invalid cell: %pM\n",
10200 hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010201 goto drop;
10202 }
10203 }
10204 break;
10205
10206 case IW_MODE_INFRA:
10207 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010208 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010209 id = 0;
10210 break;
10211 }
10212
10213 tfd = &txq->bd[q->first_empty];
10214 txq->txb[q->first_empty] = txb;
10215 memset(tfd, 0, sizeof(*tfd));
10216 tfd->u.data.station_number = id;
10217
10218 tfd->control_flags.message_type = TX_FRAME_TYPE;
10219 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10220
10221 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010222 tfd->u.data.len = cpu_to_le16(txb->payload_size);
Jeff Garzikbf794512005-07-31 13:07:26 -040010223
James Ketrenos43f66a62005-03-25 12:31:53 -060010224 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010225 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010226 else
James Ketrenosb095c382005-08-24 22:04:42 -050010227 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010228
James Ketrenosea2b26e2005-08-24 21:25:16 -050010229 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10230 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010231
James Ketrenosc848d0a2005-08-24 21:56:24 -050010232 fc = le16_to_cpu(hdr->frame_ctl);
10233 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010234
10235 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10236
James Ketrenosb095c382005-08-24 22:04:42 -050010237 if (likely(unicast))
10238 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10239
10240 if (txb->encrypted && !priv->ieee->host_encrypt) {
10241 switch (priv->ieee->sec.level) {
10242 case SEC_LEVEL_3:
10243 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010244 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010245 /* XXX: ACK flag must be set for CCMP even if it
10246 * is a multicast/broadcast packet, because CCMP
10247 * group communication encrypted by GTK is
10248 * actually done by the AP. */
10249 if (!unicast)
10250 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10251
10252 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10253 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10254 tfd->u.data.key_index = 0;
10255 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10256 break;
10257 case SEC_LEVEL_2:
10258 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010259 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010260 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10261 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10262 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10263 break;
10264 case SEC_LEVEL_1:
10265 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010266 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
John W. Linville274bfb82008-10-29 11:35:05 -040010267 tfd->u.data.key_index = priv->ieee->crypt_info.tx_keyidx;
10268 if (priv->ieee->sec.key_sizes[priv->ieee->crypt_info.tx_keyidx] <=
James Ketrenosb095c382005-08-24 22:04:42 -050010269 40)
10270 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10271 else
10272 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10273 break;
10274 case SEC_LEVEL_0:
10275 break;
10276 default:
10277 printk(KERN_ERR "Unknow security level %d\n",
10278 priv->ieee->sec.level);
10279 break;
10280 }
10281 } else
10282 /* No hardware encryption */
10283 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10284
Zhu Yie43e3c12006-04-13 17:20:45 +080010285#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010286 if (fc & IEEE80211_STYPE_QOS_DATA)
10287 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010288#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010289
James Ketrenos43f66a62005-03-25 12:31:53 -060010290 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010291 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10292 txb->nr_frags));
10293 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10294 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10295 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10296 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10297 i, le32_to_cpu(tfd->u.data.num_chunks),
10298 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010299 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010300 i, tfd->u.data.num_chunks,
10301 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010302 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010303 txb->fragments[i]->len - hdr_len);
10304
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010305 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010306 cpu_to_le32(pci_map_single
10307 (priv->pci_dev,
10308 txb->fragments[i]->data + hdr_len,
10309 txb->fragments[i]->len - hdr_len,
10310 PCI_DMA_TODEVICE));
10311 tfd->u.data.chunk_len[i] =
10312 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010313 }
10314
10315 if (i != txb->nr_frags) {
10316 struct sk_buff *skb;
10317 u16 remaining_bytes = 0;
10318 int j;
10319
10320 for (j = i; j < txb->nr_frags; j++)
10321 remaining_bytes += txb->fragments[j]->len - hdr_len;
10322
10323 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10324 remaining_bytes);
10325 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10326 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010327 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010328 for (j = i; j < txb->nr_frags; j++) {
10329 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010330
James Ketrenos43f66a62005-03-25 12:31:53 -060010331 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010332 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010333 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010334 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010335 }
10336 dev_kfree_skb_any(txb->fragments[i]);
10337 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010338 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010339 cpu_to_le32(pci_map_single
10340 (priv->pci_dev, skb->data,
Al Viro49587302007-12-27 01:57:47 -050010341 remaining_bytes,
James Ketrenosa613bff2005-08-24 21:43:11 -050010342 PCI_DMA_TODEVICE));
10343
Marcin Slusarz5c058632008-02-13 00:06:12 +010010344 le32_add_cpu(&tfd->u.data.num_chunks, 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010345 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010346 }
10347
10348 /* kick DMA */
10349 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10350 ipw_write32(priv, q->reg_w, q->first_empty);
10351
Dan Williams943dbef2008-02-14 17:49:41 -050010352 if (ipw_tx_queue_space(q) < q->high_mark)
James Ketrenosf6970142006-02-14 09:10:51 +080010353 netif_stop_queue(priv->net_dev);
10354
James Ketrenos227d2dc2005-07-28 16:25:55 -050010355 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010356
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010357 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010358 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10359 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010360 return NETDEV_TX_OK;
10361}
10362
10363static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10364{
10365 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010366#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010367 int tx_id = ipw_get_tx_queue_number(priv, pri);
10368 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10369#else
10370 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010371#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010372
Dan Williams943dbef2008-02-14 17:49:41 -050010373 if (ipw_tx_queue_space(&txq->q) < txq->q.high_mark)
James Ketrenos227d2dc2005-07-28 16:25:55 -050010374 return 1;
10375
10376 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010377}
10378
Zhu Yid685b8c2006-04-13 17:20:27 +080010379#ifdef CONFIG_IPW2200_PROMISCUOUS
10380static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10381 struct ieee80211_txb *txb)
10382{
10383 struct ieee80211_rx_stats dummystats;
10384 struct ieee80211_hdr *hdr;
10385 u8 n;
10386 u16 filter = priv->prom_priv->filter;
10387 int hdr_only = 0;
10388
10389 if (filter & IPW_PROM_NO_TX)
10390 return;
10391
10392 memset(&dummystats, 0, sizeof(dummystats));
10393
10394 /* Filtering of fragment chains is done agains the first fragment */
10395 hdr = (void *)txb->fragments[0]->data;
John W. Linville72118012008-09-30 21:43:03 -040010396 if (ieee80211_is_management(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010397 if (filter & IPW_PROM_NO_MGMT)
10398 return;
10399 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10400 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -040010401 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010402 if (filter & IPW_PROM_NO_CTL)
10403 return;
10404 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10405 hdr_only = 1;
John W. Linville72118012008-09-30 21:43:03 -040010406 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_control))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010407 if (filter & IPW_PROM_NO_DATA)
10408 return;
10409 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10410 hdr_only = 1;
10411 }
10412
10413 for(n=0; n<txb->nr_frags; ++n) {
10414 struct sk_buff *src = txb->fragments[n];
10415 struct sk_buff *dst;
10416 struct ieee80211_radiotap_header *rt_hdr;
10417 int len;
10418
10419 if (hdr_only) {
10420 hdr = (void *)src->data;
John W. Linville72118012008-09-30 21:43:03 -040010421 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_control));
Zhu Yid685b8c2006-04-13 17:20:27 +080010422 } else
10423 len = src->len;
10424
Johannes Berg007e5dd2008-11-27 23:13:38 +010010425 dst = alloc_skb(len + sizeof(*rt_hdr), GFP_ATOMIC);
10426 if (!dst)
10427 continue;
Zhu Yid685b8c2006-04-13 17:20:27 +080010428
10429 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10430
10431 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10432 rt_hdr->it_pad = 0;
10433 rt_hdr->it_present = 0; /* after all, it's just an idea */
Al Viro743b84d2007-12-27 01:43:16 -050010434 rt_hdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_CHANNEL);
Zhu Yid685b8c2006-04-13 17:20:27 +080010435
Al Viroe62e1ee2007-12-27 01:36:46 -050010436 *(__le16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
Zhu Yid685b8c2006-04-13 17:20:27 +080010437 ieee80211chan2mhz(priv->channel));
10438 if (priv->channel > 14) /* 802.11a */
Al Viroe62e1ee2007-12-27 01:36:46 -050010439 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010440 cpu_to_le16(IEEE80211_CHAN_OFDM |
10441 IEEE80211_CHAN_5GHZ);
10442 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
Al Viroe62e1ee2007-12-27 01:36:46 -050010443 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010444 cpu_to_le16(IEEE80211_CHAN_CCK |
10445 IEEE80211_CHAN_2GHZ);
10446 else /* 802.11g */
Al Viroe62e1ee2007-12-27 01:36:46 -050010447 *(__le16*)skb_put(dst, sizeof(u16)) =
Zhu Yid685b8c2006-04-13 17:20:27 +080010448 cpu_to_le16(IEEE80211_CHAN_OFDM |
10449 IEEE80211_CHAN_2GHZ);
10450
Al Viro743b84d2007-12-27 01:43:16 -050010451 rt_hdr->it_len = cpu_to_le16(dst->len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010452
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -030010453 skb_copy_from_linear_data(src, skb_put(dst, len), len);
Zhu Yid685b8c2006-04-13 17:20:27 +080010454
10455 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10456 dev_kfree_skb_any(dst);
10457 }
10458}
10459#endif
10460
James Ketrenos43f66a62005-03-25 12:31:53 -060010461static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010462 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010463{
10464 struct ipw_priv *priv = ieee80211_priv(dev);
10465 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010466 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010467
10468 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010469 spin_lock_irqsave(&priv->lock, flags);
10470
Zhu Yid685b8c2006-04-13 17:20:27 +080010471#ifdef CONFIG_IPW2200_PROMISCUOUS
10472 if (rtap_iface && netif_running(priv->prom_net_dev))
10473 ipw_handle_promiscuous_tx(priv, txb);
10474#endif
10475
James Ketrenos227d2dc2005-07-28 16:25:55 -050010476 ret = ipw_tx_skb(priv, txb, pri);
10477 if (ret == NETDEV_TX_OK)
10478 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010479 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010480
James Ketrenos227d2dc2005-07-28 16:25:55 -050010481 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010482}
10483
James Ketrenos43f66a62005-03-25 12:31:53 -060010484static void ipw_net_set_multicast_list(struct net_device *dev)
10485{
10486
10487}
10488
10489static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10490{
10491 struct ipw_priv *priv = ieee80211_priv(dev);
10492 struct sockaddr *addr = p;
Joe Perches0795af52007-10-03 17:59:30 -070010493
James Ketrenos43f66a62005-03-25 12:31:53 -060010494 if (!is_valid_ether_addr(addr->sa_data))
10495 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010496 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010497 priv->config |= CFG_CUSTOM_MAC;
10498 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
Johannes Berge1749612008-10-27 15:59:26 -070010499 printk(KERN_INFO "%s: Setting MAC to %pM\n",
10500 priv->net_dev->name, priv->mac_addr);
James Ketrenosa613bff2005-08-24 21:43:11 -050010501 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010502 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010503 return 0;
10504}
10505
Jeff Garzikbf794512005-07-31 13:07:26 -040010506static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010507 struct ethtool_drvinfo *info)
10508{
10509 struct ipw_priv *p = ieee80211_priv(dev);
10510 char vers[64];
10511 char date[32];
10512 u32 len;
10513
10514 strcpy(info->driver, DRV_NAME);
10515 strcpy(info->version, DRV_VERSION);
10516
10517 len = sizeof(vers);
10518 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10519 len = sizeof(date);
10520 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10521
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010522 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010523 vers, date);
10524 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010525 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010526}
10527
10528static u32 ipw_ethtool_get_link(struct net_device *dev)
10529{
10530 struct ipw_priv *priv = ieee80211_priv(dev);
10531 return (priv->status & STATUS_ASSOCIATED) != 0;
10532}
10533
10534static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10535{
James Ketrenosb095c382005-08-24 22:04:42 -050010536 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010537}
10538
10539static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010540 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010541{
10542 struct ipw_priv *p = ieee80211_priv(dev);
10543
James Ketrenosb095c382005-08-24 22:04:42 -050010544 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010545 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010546 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010547 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010548 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010549 return 0;
10550}
10551
10552static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010553 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010554{
10555 struct ipw_priv *p = ieee80211_priv(dev);
10556 int i;
10557
James Ketrenosb095c382005-08-24 22:04:42 -050010558 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010559 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010560 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010561 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010562 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10563 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010564 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010565 return 0;
10566}
10567
Jeff Garzik7282d492006-09-13 14:30:00 -040010568static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010569 .get_link = ipw_ethtool_get_link,
10570 .get_drvinfo = ipw_ethtool_get_drvinfo,
10571 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10572 .get_eeprom = ipw_ethtool_get_eeprom,
10573 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010574};
10575
David Howells7d12e782006-10-05 14:55:46 +010010576static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010577{
10578 struct ipw_priv *priv = data;
10579 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010580
James Ketrenos43f66a62005-03-25 12:31:53 -060010581 if (!priv)
10582 return IRQ_NONE;
10583
Zhu Yi89c318e2006-06-08 22:19:49 -070010584 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010585
10586 if (!(priv->status & STATUS_INT_ENABLED)) {
Zhu Yid00d0122007-07-12 16:09:40 +080010587 /* IRQ is disabled */
James Ketrenos43f66a62005-03-25 12:31:53 -060010588 goto none;
10589 }
10590
James Ketrenosb095c382005-08-24 22:04:42 -050010591 inta = ipw_read32(priv, IPW_INTA_RW);
10592 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010593
James Ketrenos43f66a62005-03-25 12:31:53 -060010594 if (inta == 0xFFFFFFFF) {
10595 /* Hardware disappeared */
10596 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10597 goto none;
10598 }
10599
James Ketrenosb095c382005-08-24 22:04:42 -050010600 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010601 /* Shared interrupt */
10602 goto none;
10603 }
10604
10605 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010606 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010607
James Ketrenos43f66a62005-03-25 12:31:53 -060010608 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010609 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10610 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010611
James Ketrenos43f66a62005-03-25 12:31:53 -060010612 /* Cache INTA value for our tasklet */
10613 priv->isr_inta = inta;
10614
10615 tasklet_schedule(&priv->irq_tasklet);
10616
Zhu Yi89c318e2006-06-08 22:19:49 -070010617 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010618
10619 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010620 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010621 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010622 return IRQ_NONE;
10623}
10624
10625static void ipw_rf_kill(void *adapter)
10626{
10627 struct ipw_priv *priv = adapter;
10628 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010629
James Ketrenos43f66a62005-03-25 12:31:53 -060010630 spin_lock_irqsave(&priv->lock, flags);
10631
10632 if (rf_kill_active(priv)) {
10633 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10634 if (priv->workqueue)
10635 queue_delayed_work(priv->workqueue,
10636 &priv->rf_kill, 2 * HZ);
10637 goto exit_unlock;
10638 }
10639
10640 /* RF Kill is now disabled, so bring the device back up */
10641
10642 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10643 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10644 "device\n");
10645
10646 /* we can not do an adapter restart while inside an irq lock */
10647 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010648 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010649 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10650 "enabled\n");
10651
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010652 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010653 spin_unlock_irqrestore(&priv->lock, flags);
10654}
10655
David Howellsc4028952006-11-22 14:57:56 +000010656static void ipw_bg_rf_kill(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010657{
David Howellsc4028952006-11-22 14:57:56 +000010658 struct ipw_priv *priv =
10659 container_of(work, struct ipw_priv, rf_kill.work);
Zhu Yi46441512006-01-24 16:37:59 +080010660 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010661 ipw_rf_kill(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010662 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010663}
10664
Adrian Bunka73e22b2006-01-21 01:39:42 +010010665static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010666{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010667 priv->last_seq_num = -1;
10668 priv->last_frag_num = -1;
10669 priv->last_packet_time = 0;
10670
James Ketrenosa613bff2005-08-24 21:43:11 -050010671 netif_carrier_on(priv->net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050010672
James Ketrenosc848d0a2005-08-24 21:56:24 -050010673 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010674 cancel_delayed_work(&priv->request_direct_scan);
10675 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010676 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010677 ipw_reset_stats(priv);
10678 /* Ensure the rate is updated immediately */
10679 priv->last_rate = ipw_get_current_rate(priv);
10680 ipw_gather_stats(priv);
10681 ipw_led_link_up(priv);
10682 notify_wx_assoc_event(priv);
10683
10684 if (priv->config & CFG_BACKGROUND_SCAN)
10685 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10686}
10687
David Howellsc4028952006-11-22 14:57:56 +000010688static void ipw_bg_link_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010689{
David Howellsc4028952006-11-22 14:57:56 +000010690 struct ipw_priv *priv =
10691 container_of(work, struct ipw_priv, link_up);
Zhu Yi46441512006-01-24 16:37:59 +080010692 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010693 ipw_link_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010694 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010695}
10696
Adrian Bunka73e22b2006-01-21 01:39:42 +010010697static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010698{
10699 ipw_led_link_down(priv);
10700 netif_carrier_off(priv->net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050010701 notify_wx_assoc_event(priv);
10702
10703 /* Cancel any queued work ... */
10704 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010705 cancel_delayed_work(&priv->request_direct_scan);
10706 cancel_delayed_work(&priv->request_passive_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -050010707 cancel_delayed_work(&priv->adhoc_check);
10708 cancel_delayed_work(&priv->gather_stats);
10709
10710 ipw_reset_stats(priv);
10711
James Ketrenosafbf30a2005-08-25 00:05:33 -050010712 if (!(priv->status & STATUS_EXIT_PENDING)) {
10713 /* Queue up another scan... */
David Howellsc4028952006-11-22 14:57:56 +000010714 queue_delayed_work(priv->workqueue, &priv->request_scan, 0);
Dan Williams0b531672007-10-09 13:55:24 -040010715 } else
10716 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050010717}
10718
David Howellsc4028952006-11-22 14:57:56 +000010719static void ipw_bg_link_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050010720{
David Howellsc4028952006-11-22 14:57:56 +000010721 struct ipw_priv *priv =
10722 container_of(work, struct ipw_priv, link_down);
Zhu Yi46441512006-01-24 16:37:59 +080010723 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000010724 ipw_link_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080010725 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010726}
10727
Adrian Bunk2ef19e62007-12-11 23:20:22 +010010728static int __devinit ipw_setup_deferred_work(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010729{
10730 int ret = 0;
10731
James Ketrenos43f66a62005-03-25 12:31:53 -060010732 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010733 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010734 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010735
David Howellsc4028952006-11-22 14:57:56 +000010736 INIT_DELAYED_WORK(&priv->adhoc_check, ipw_bg_adhoc_check);
10737 INIT_WORK(&priv->associate, ipw_bg_associate);
10738 INIT_WORK(&priv->disassociate, ipw_bg_disassociate);
10739 INIT_WORK(&priv->system_config, ipw_system_config);
10740 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish);
10741 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart);
10742 INIT_DELAYED_WORK(&priv->rf_kill, ipw_bg_rf_kill);
10743 INIT_WORK(&priv->up, ipw_bg_up);
10744 INIT_WORK(&priv->down, ipw_bg_down);
10745 INIT_DELAYED_WORK(&priv->request_scan, ipw_request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040010746 INIT_DELAYED_WORK(&priv->request_direct_scan, ipw_request_direct_scan);
10747 INIT_DELAYED_WORK(&priv->request_passive_scan, ipw_request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040010748 INIT_DELAYED_WORK(&priv->scan_event, ipw_scan_event);
David Howellsc4028952006-11-22 14:57:56 +000010749 INIT_DELAYED_WORK(&priv->gather_stats, ipw_bg_gather_stats);
10750 INIT_WORK(&priv->abort_scan, ipw_bg_abort_scan);
10751 INIT_WORK(&priv->roam, ipw_bg_roam);
10752 INIT_DELAYED_WORK(&priv->scan_check, ipw_bg_scan_check);
10753 INIT_WORK(&priv->link_up, ipw_bg_link_up);
10754 INIT_WORK(&priv->link_down, ipw_bg_link_down);
10755 INIT_DELAYED_WORK(&priv->led_link_on, ipw_bg_led_link_on);
10756 INIT_DELAYED_WORK(&priv->led_link_off, ipw_bg_led_link_off);
10757 INIT_DELAYED_WORK(&priv->led_act_off, ipw_bg_led_activity_off);
10758 INIT_WORK(&priv->merge_networks, ipw_merge_adhoc_network);
James Ketrenos43f66a62005-03-25 12:31:53 -060010759
Zhu Yie43e3c12006-04-13 17:20:45 +080010760#ifdef CONFIG_IPW2200_QOS
David Howellsc4028952006-11-22 14:57:56 +000010761 INIT_WORK(&priv->qos_activate, ipw_bg_qos_activate);
Zhu Yie43e3c12006-04-13 17:20:45 +080010762#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010763
10764 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10765 ipw_irq_tasklet, (unsigned long)priv);
10766
10767 return ret;
10768}
10769
James Ketrenos43f66a62005-03-25 12:31:53 -060010770static void shim__set_security(struct net_device *dev,
10771 struct ieee80211_security *sec)
10772{
10773 struct ipw_priv *priv = ieee80211_priv(dev);
10774 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010775 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010776 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010777 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010778 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010779 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010780 priv->ieee->sec.flags &= ~(1 << i);
10781 else {
10782 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010783 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010784 priv->ieee->sec.flags |= (1 << i);
10785 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010786 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010787 } else if (sec->level != SEC_LEVEL_1)
10788 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010789 }
10790
James Ketrenosb095c382005-08-24 22:04:42 -050010791 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010792 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010793 priv->ieee->sec.active_key = sec->active_key;
10794 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010795 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010796 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010797 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010798 } else
10799 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010800
10801 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010802 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10803 priv->ieee->sec.auth_mode = sec->auth_mode;
10804 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010805 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10806 priv->capability |= CAP_SHARED_KEY;
10807 else
10808 priv->capability &= ~CAP_SHARED_KEY;
10809 priv->status |= STATUS_SECURITY_UPDATED;
10810 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010811
James Ketrenosb095c382005-08-24 22:04:42 -050010812 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10813 priv->ieee->sec.flags |= SEC_ENABLED;
10814 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010815 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010816 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010817 priv->capability |= CAP_PRIVACY_ON;
10818 else
10819 priv->capability &= ~CAP_PRIVACY_ON;
10820 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010821
James Ketrenosafbf30a2005-08-25 00:05:33 -050010822 if (sec->flags & SEC_ENCRYPT)
10823 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010824
James Ketrenosb095c382005-08-24 22:04:42 -050010825 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10826 priv->ieee->sec.level = sec->level;
10827 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010828 priv->status |= STATUS_SECURITY_UPDATED;
10829 }
10830
Zhu Yi1fbfea52005-08-05 17:22:56 +080010831 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10832 ipw_set_hwcrypto_keys(priv);
10833
Jeff Garzikbf794512005-07-31 13:07:26 -040010834 /* To match current functionality of ipw2100 (which works well w/
10835 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010836 * privacy capability changes ... */
10837#if 0
10838 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010839 (((priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010840 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010841 (!(priv->assoc_request.capability &
Al Viro5b5e8072007-12-27 01:54:06 -050010842 cpu_to_le16(WLAN_CAPABILITY_PRIVACY)) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010843 IPW_DEBUG_ASSOC("Disassociating due to capability "
10844 "change.\n");
10845 ipw_disassociate(priv);
10846 }
10847#endif
10848}
10849
Jeff Garzikbf794512005-07-31 13:07:26 -040010850static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010851 struct ipw_supported_rates *rates)
10852{
10853 /* TODO: Mask out rates based on priv->rates_mask */
10854
10855 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010856 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010857 switch (priv->ieee->freq_band) {
10858 case IEEE80211_52GHZ_BAND:
10859 rates->ieee_mode = IPW_A_MODE;
10860 rates->purpose = IPW_RATE_CAPABILITIES;
10861 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10862 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10863 break;
10864
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010865 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010866 rates->ieee_mode = IPW_G_MODE;
10867 rates->purpose = IPW_RATE_CAPABILITIES;
10868 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10869 IEEE80211_CCK_DEFAULT_RATES_MASK);
10870 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10871 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10872 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10873 }
10874 break;
10875 }
10876
10877 return 0;
10878}
10879
Jeff Garzikbf794512005-07-31 13:07:26 -040010880static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010881{
James Ketrenos43f66a62005-03-25 12:31:53 -060010882 /* This is only called from ipw_up, which resets/reloads the firmware
10883 so, we don't need to first disable the card before we configure
10884 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010885 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010886 goto error;
10887
10888 /* initialize adapter address */
10889 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10890 goto error;
10891
10892 /* set basic system config settings */
10893 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010894
10895 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10896 * Does not support BT priority yet (don't abort or defer our Tx) */
10897 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010898 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010899
10900 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10901 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010902 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010903 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10904 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010905 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010906 }
10907
Zhu Yid685b8c2006-04-13 17:20:27 +080010908#ifdef CONFIG_IPW2200_PROMISCUOUS
10909 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10910 priv->sys_config.accept_all_data_frames = 1;
10911 priv->sys_config.accept_non_directed_frames = 1;
10912 priv->sys_config.accept_all_mgmt_bcpr = 1;
10913 priv->sys_config.accept_all_mgmt_frames = 1;
10914 }
10915#endif
10916
James Ketrenosc848d0a2005-08-24 21:56:24 -050010917 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10918 priv->sys_config.answer_broadcast_ssid_probe = 1;
10919 else
10920 priv->sys_config.answer_broadcast_ssid_probe = 0;
10921
Zhu Yid685b8c2006-04-13 17:20:27 +080010922 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010923 goto error;
10924
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010925 init_supported_rates(priv, &priv->rates);
10926 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010927 goto error;
10928
10929 /* Set request-to-send threshold */
10930 if (priv->rts_threshold) {
10931 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10932 goto error;
10933 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010934#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010935 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10936 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010937#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010938
10939 if (ipw_set_random_seed(priv))
10940 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010941
James Ketrenos43f66a62005-03-25 12:31:53 -060010942 /* final state transition to the RUN state */
10943 if (ipw_send_host_complete(priv))
10944 goto error;
10945
James Ketrenose6666192005-08-12 09:17:04 -050010946 priv->status |= STATUS_INIT;
10947
10948 ipw_led_init(priv);
10949 ipw_led_radio_on(priv);
10950 priv->notif_missed_beacons = 0;
10951
10952 /* Set hardware WEP key if it is configured. */
10953 if ((priv->capability & CAP_PRIVACY_ON) &&
10954 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10955 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10956 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010957
10958 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010959
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010960 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010961 return -EIO;
10962}
10963
James Ketrenos4f36f802005-08-03 20:36:56 -050010964/*
10965 * NOTE:
10966 *
10967 * These tables have been tested in conjunction with the
10968 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
10969 *
10970 * Altering this values, using it on other hardware, or in geographies
10971 * not intended for resale of the above mentioned Intel adapters has
10972 * not been tested.
10973 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080010974 * Remember to update the table in README.ipw2200 when changing this
10975 * table.
10976 *
James Ketrenos4f36f802005-08-03 20:36:56 -050010977 */
10978static const struct ieee80211_geo ipw_geos[] = {
10979 { /* Restricted */
10980 "---",
10981 .bg_channels = 11,
10982 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10983 {2427, 4}, {2432, 5}, {2437, 6},
10984 {2442, 7}, {2447, 8}, {2452, 9},
10985 {2457, 10}, {2462, 11}},
10986 },
10987
10988 { /* Custom US/Canada */
10989 "ZZF",
10990 .bg_channels = 11,
10991 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10992 {2427, 4}, {2432, 5}, {2437, 6},
10993 {2442, 7}, {2447, 8}, {2452, 9},
10994 {2457, 10}, {2462, 11}},
10995 .a_channels = 8,
10996 .a = {{5180, 36},
10997 {5200, 40},
10998 {5220, 44},
10999 {5240, 48},
11000 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11001 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11002 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11003 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
11004 },
11005
11006 { /* Rest of World */
11007 "ZZD",
11008 .bg_channels = 13,
11009 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11010 {2427, 4}, {2432, 5}, {2437, 6},
11011 {2442, 7}, {2447, 8}, {2452, 9},
11012 {2457, 10}, {2462, 11}, {2467, 12},
11013 {2472, 13}},
11014 },
11015
11016 { /* Custom USA & Europe & High */
11017 "ZZA",
11018 .bg_channels = 11,
11019 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11020 {2427, 4}, {2432, 5}, {2437, 6},
11021 {2442, 7}, {2447, 8}, {2452, 9},
11022 {2457, 10}, {2462, 11}},
11023 .a_channels = 13,
11024 .a = {{5180, 36},
11025 {5200, 40},
11026 {5220, 44},
11027 {5240, 48},
11028 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11029 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11030 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11031 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11032 {5745, 149},
11033 {5765, 153},
11034 {5785, 157},
11035 {5805, 161},
11036 {5825, 165}},
11037 },
11038
11039 { /* Custom NA & Europe */
11040 "ZZB",
11041 .bg_channels = 11,
11042 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11043 {2427, 4}, {2432, 5}, {2437, 6},
11044 {2442, 7}, {2447, 8}, {2452, 9},
11045 {2457, 10}, {2462, 11}},
11046 .a_channels = 13,
11047 .a = {{5180, 36},
11048 {5200, 40},
11049 {5220, 44},
11050 {5240, 48},
11051 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11052 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11053 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11054 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11055 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11056 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11057 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11058 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11059 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11060 },
11061
11062 { /* Custom Japan */
11063 "ZZC",
11064 .bg_channels = 11,
11065 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11066 {2427, 4}, {2432, 5}, {2437, 6},
11067 {2442, 7}, {2447, 8}, {2452, 9},
11068 {2457, 10}, {2462, 11}},
11069 .a_channels = 4,
11070 .a = {{5170, 34}, {5190, 38},
11071 {5210, 42}, {5230, 46}},
11072 },
11073
11074 { /* Custom */
11075 "ZZM",
11076 .bg_channels = 11,
11077 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11078 {2427, 4}, {2432, 5}, {2437, 6},
11079 {2442, 7}, {2447, 8}, {2452, 9},
11080 {2457, 10}, {2462, 11}},
11081 },
11082
11083 { /* Europe */
11084 "ZZE",
11085 .bg_channels = 13,
11086 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11087 {2427, 4}, {2432, 5}, {2437, 6},
11088 {2442, 7}, {2447, 8}, {2452, 9},
11089 {2457, 10}, {2462, 11}, {2467, 12},
11090 {2472, 13}},
11091 .a_channels = 19,
11092 .a = {{5180, 36},
11093 {5200, 40},
11094 {5220, 44},
11095 {5240, 48},
11096 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11097 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11098 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11099 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11100 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11101 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11102 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11103 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11104 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11105 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11106 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11107 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11108 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11109 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11110 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11111 },
11112
11113 { /* Custom Japan */
11114 "ZZJ",
11115 .bg_channels = 14,
11116 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11117 {2427, 4}, {2432, 5}, {2437, 6},
11118 {2442, 7}, {2447, 8}, {2452, 9},
11119 {2457, 10}, {2462, 11}, {2467, 12},
11120 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11121 .a_channels = 4,
11122 .a = {{5170, 34}, {5190, 38},
11123 {5210, 42}, {5230, 46}},
11124 },
11125
James Ketrenos03520572005-10-19 16:12:31 -050011126 { /* Rest of World */
11127 "ZZR",
11128 .bg_channels = 14,
11129 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11130 {2427, 4}, {2432, 5}, {2437, 6},
11131 {2442, 7}, {2447, 8}, {2452, 9},
11132 {2457, 10}, {2462, 11}, {2467, 12},
11133 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11134 IEEE80211_CH_PASSIVE_ONLY}},
11135 },
11136
James Ketrenos4f36f802005-08-03 20:36:56 -050011137 { /* High Band */
11138 "ZZH",
11139 .bg_channels = 13,
11140 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11141 {2427, 4}, {2432, 5}, {2437, 6},
11142 {2442, 7}, {2447, 8}, {2452, 9},
11143 {2457, 10}, {2462, 11},
11144 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11145 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11146 .a_channels = 4,
11147 .a = {{5745, 149}, {5765, 153},
11148 {5785, 157}, {5805, 161}},
11149 },
11150
11151 { /* Custom Europe */
11152 "ZZG",
11153 .bg_channels = 13,
11154 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11155 {2427, 4}, {2432, 5}, {2437, 6},
11156 {2442, 7}, {2447, 8}, {2452, 9},
11157 {2457, 10}, {2462, 11},
11158 {2467, 12}, {2472, 13}},
11159 .a_channels = 4,
11160 .a = {{5180, 36}, {5200, 40},
11161 {5220, 44}, {5240, 48}},
11162 },
11163
11164 { /* Europe */
11165 "ZZK",
11166 .bg_channels = 13,
11167 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11168 {2427, 4}, {2432, 5}, {2437, 6},
11169 {2442, 7}, {2447, 8}, {2452, 9},
11170 {2457, 10}, {2462, 11},
11171 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11172 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11173 .a_channels = 24,
11174 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11175 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11176 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11177 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11178 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11179 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11180 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11181 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11182 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11183 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11184 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11185 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11186 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11187 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11188 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11189 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11190 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11191 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11192 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11193 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11194 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11195 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11196 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11197 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11198 },
11199
11200 { /* Europe */
11201 "ZZL",
11202 .bg_channels = 11,
11203 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11204 {2427, 4}, {2432, 5}, {2437, 6},
11205 {2442, 7}, {2447, 8}, {2452, 9},
11206 {2457, 10}, {2462, 11}},
11207 .a_channels = 13,
11208 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11209 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11210 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11211 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11212 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11213 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11214 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11215 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11216 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11217 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11218 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11219 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11220 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11221 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011222};
11223
James Ketrenos43f66a62005-03-25 12:31:53 -060011224#define MAX_HW_RESTARTS 5
11225static int ipw_up(struct ipw_priv *priv)
11226{
James Ketrenos4f36f802005-08-03 20:36:56 -050011227 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011228
Dan Williamsc3d72b92009-02-11 13:26:06 -050011229 /* Age scan list entries found before suspend */
11230 if (priv->suspend_time) {
11231 ieee80211_networks_age(priv->ieee, priv->suspend_time);
11232 priv->suspend_time = 0;
11233 }
11234
James Ketrenos43f66a62005-03-25 12:31:53 -060011235 if (priv->status & STATUS_EXIT_PENDING)
11236 return -EIO;
11237
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011238 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011239 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011240 GFP_KERNEL);
11241 if (priv->cmdlog == NULL) {
11242 IPW_ERROR("Error allocating %d command log entries.\n",
11243 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011244 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011245 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011246 priv->cmdlog_len = cmdlog;
11247 }
11248 }
11249
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011250 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011251 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011252 * Also start the clocks. */
11253 rc = ipw_load(priv);
11254 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011255 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011256 return rc;
11257 }
11258
11259 ipw_init_ordinals(priv);
11260 if (!(priv->config & CFG_CUSTOM_MAC))
11261 eeprom_parse_mac(priv, priv->mac_addr);
11262 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11263
James Ketrenos4f36f802005-08-03 20:36:56 -050011264 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11265 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11266 ipw_geos[j].name, 3))
11267 break;
11268 }
James Ketrenos03520572005-10-19 16:12:31 -050011269 if (j == ARRAY_SIZE(ipw_geos)) {
11270 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11271 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11272 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11273 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011274 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011275 }
Larry Finger1867b112006-02-28 09:48:28 -060011276 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011277 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011278 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011279 }
11280
James Ketrenosb095c382005-08-24 22:04:42 -050011281 if (priv->status & STATUS_RF_KILL_SW) {
11282 IPW_WARNING("Radio disabled by module parameter.\n");
11283 return 0;
11284 } else if (rf_kill_active(priv)) {
11285 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11286 "Kill switch must be turned off for "
11287 "wireless networking to work.\n");
11288 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11289 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011290 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011291 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011292
11293 rc = ipw_config(priv);
11294 if (!rc) {
11295 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011296
James Ketrenose6666192005-08-12 09:17:04 -050011297 /* If configure to try and auto-associate, kick
11298 * off a scan. */
David Howellsc4028952006-11-22 14:57:56 +000011299 queue_delayed_work(priv->workqueue,
11300 &priv->request_scan, 0);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011301
James Ketrenos43f66a62005-03-25 12:31:53 -060011302 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011303 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011304
James Ketrenosc848d0a2005-08-24 21:56:24 -050011305 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011306 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11307 i, MAX_HW_RESTARTS);
11308
11309 /* We had an error bringing up the hardware, so take it
11310 * all the way back down so we can try again */
11311 ipw_down(priv);
11312 }
11313
Jeff Garzikbf794512005-07-31 13:07:26 -040011314 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011315 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011316 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011317
James Ketrenos43f66a62005-03-25 12:31:53 -060011318 return -EIO;
11319}
11320
David Howellsc4028952006-11-22 14:57:56 +000011321static void ipw_bg_up(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011322{
David Howellsc4028952006-11-22 14:57:56 +000011323 struct ipw_priv *priv =
11324 container_of(work, struct ipw_priv, up);
Zhu Yi46441512006-01-24 16:37:59 +080011325 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011326 ipw_up(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011327 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011328}
11329
James Ketrenosb095c382005-08-24 22:04:42 -050011330static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011331{
James Ketrenosb095c382005-08-24 22:04:42 -050011332 int i;
11333
11334 if (priv->status & STATUS_SCANNING) {
11335 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11336 ipw_abort_scan(priv);
11337 }
11338
11339 if (priv->status & STATUS_ASSOCIATED) {
11340 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11341 ipw_disassociate(priv);
11342 }
11343
11344 ipw_led_shutdown(priv);
11345
11346 /* Wait up to 1s for status to change to not scanning and not
11347 * associated (disassociation can take a while for a ful 802.11
11348 * exchange */
11349 for (i = 1000; i && (priv->status &
11350 (STATUS_DISASSOCIATING |
11351 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11352 udelay(10);
11353
11354 if (priv->status & (STATUS_DISASSOCIATING |
11355 STATUS_ASSOCIATED | STATUS_SCANNING))
11356 IPW_DEBUG_INFO("Still associated or scanning...\n");
11357 else
11358 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11359
James Ketrenosc848d0a2005-08-24 21:56:24 -050011360 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011361 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011362
11363 priv->status &= ~STATUS_INIT;
11364}
11365
James Ketrenos43f66a62005-03-25 12:31:53 -060011366static void ipw_down(struct ipw_priv *priv)
11367{
James Ketrenosb095c382005-08-24 22:04:42 -050011368 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11369
11370 priv->status |= STATUS_EXIT_PENDING;
11371
11372 if (ipw_is_init(priv))
11373 ipw_deinit(priv);
11374
11375 /* Wipe out the EXIT_PENDING status bit if we are not actually
11376 * exiting the module */
11377 if (!exit_pending)
11378 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011379
11380 /* tell the device to stop sending interrupts */
11381 ipw_disable_interrupts(priv);
11382
11383 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011384 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011385 netif_carrier_off(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011386
11387 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011388
11389 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011390}
11391
David Howellsc4028952006-11-22 14:57:56 +000011392static void ipw_bg_down(struct work_struct *work)
James Ketrenosc848d0a2005-08-24 21:56:24 -050011393{
David Howellsc4028952006-11-22 14:57:56 +000011394 struct ipw_priv *priv =
11395 container_of(work, struct ipw_priv, down);
Zhu Yi46441512006-01-24 16:37:59 +080011396 mutex_lock(&priv->mutex);
David Howellsc4028952006-11-22 14:57:56 +000011397 ipw_down(priv);
Zhu Yi46441512006-01-24 16:37:59 +080011398 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011399}
11400
11401/* Called by register_netdev() */
11402static int ipw_net_init(struct net_device *dev)
11403{
11404 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011405 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011406
James Ketrenosc848d0a2005-08-24 21:56:24 -050011407 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011408 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011409 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011410 }
11411
Zhu Yi46441512006-01-24 16:37:59 +080011412 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011413 return 0;
11414}
11415
11416/* PCI driver stuff */
11417static struct pci_device_id card_ids[] = {
11418 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11419 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11420 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11421 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11422 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11423 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11424 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11425 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11426 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11427 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11428 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11429 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11430 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11431 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11432 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11433 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11434 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
Joe Perches8ab0ea72009-06-24 22:13:27 -070011435 {PCI_VDEVICE(INTEL, 0x104f), 0},
11436 {PCI_VDEVICE(INTEL, 0x4220), 0}, /* BG */
11437 {PCI_VDEVICE(INTEL, 0x4221), 0}, /* BG */
11438 {PCI_VDEVICE(INTEL, 0x4223), 0}, /* ABG */
11439 {PCI_VDEVICE(INTEL, 0x4224), 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011440
James Ketrenos43f66a62005-03-25 12:31:53 -060011441 /* required last entry */
11442 {0,}
11443};
11444
11445MODULE_DEVICE_TABLE(pci, card_ids);
11446
11447static struct attribute *ipw_sysfs_entries[] = {
11448 &dev_attr_rf_kill.attr,
11449 &dev_attr_direct_dword.attr,
11450 &dev_attr_indirect_byte.attr,
11451 &dev_attr_indirect_dword.attr,
11452 &dev_attr_mem_gpio_reg.attr,
11453 &dev_attr_command_event_reg.attr,
11454 &dev_attr_nic_type.attr,
11455 &dev_attr_status.attr,
11456 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011457 &dev_attr_error.attr,
11458 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011459 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011460 &dev_attr_eeprom_delay.attr,
11461 &dev_attr_ucode_version.attr,
11462 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011463 &dev_attr_scan_age.attr,
11464 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011465 &dev_attr_speed_scan.attr,
11466 &dev_attr_net_stats.attr,
Zhu Yi375dd242007-02-14 16:04:24 +080011467 &dev_attr_channels.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011468#ifdef CONFIG_IPW2200_PROMISCUOUS
11469 &dev_attr_rtap_iface.attr,
11470 &dev_attr_rtap_filter.attr,
11471#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011472 NULL
11473};
11474
11475static struct attribute_group ipw_attribute_group = {
11476 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011477 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011478};
11479
Zhu Yid685b8c2006-04-13 17:20:27 +080011480#ifdef CONFIG_IPW2200_PROMISCUOUS
11481static int ipw_prom_open(struct net_device *dev)
11482{
11483 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11484 struct ipw_priv *priv = prom_priv->priv;
11485
11486 IPW_DEBUG_INFO("prom dev->open\n");
11487 netif_carrier_off(dev);
Zhu Yid685b8c2006-04-13 17:20:27 +080011488
11489 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11490 priv->sys_config.accept_all_data_frames = 1;
11491 priv->sys_config.accept_non_directed_frames = 1;
11492 priv->sys_config.accept_all_mgmt_bcpr = 1;
11493 priv->sys_config.accept_all_mgmt_frames = 1;
11494
11495 ipw_send_system_config(priv);
11496 }
11497
11498 return 0;
11499}
11500
11501static int ipw_prom_stop(struct net_device *dev)
11502{
11503 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11504 struct ipw_priv *priv = prom_priv->priv;
11505
11506 IPW_DEBUG_INFO("prom dev->stop\n");
11507
11508 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11509 priv->sys_config.accept_all_data_frames = 0;
11510 priv->sys_config.accept_non_directed_frames = 0;
11511 priv->sys_config.accept_all_mgmt_bcpr = 0;
11512 priv->sys_config.accept_all_mgmt_frames = 0;
11513
11514 ipw_send_system_config(priv);
11515 }
11516
11517 return 0;
11518}
11519
11520static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11521{
11522 IPW_DEBUG_INFO("prom dev->xmit\n");
Patrick McHardy4153e772009-06-12 04:08:02 +000011523 dev_kfree_skb(skb);
11524 return NETDEV_TX_OK;
Zhu Yid685b8c2006-04-13 17:20:27 +080011525}
11526
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011527static const struct net_device_ops ipw_prom_netdev_ops = {
11528 .ndo_open = ipw_prom_open,
11529 .ndo_stop = ipw_prom_stop,
11530 .ndo_start_xmit = ipw_prom_hard_start_xmit,
11531 .ndo_change_mtu = ieee80211_change_mtu,
11532 .ndo_set_mac_address = eth_mac_addr,
11533 .ndo_validate_addr = eth_validate_addr,
11534};
11535
Zhu Yid685b8c2006-04-13 17:20:27 +080011536static int ipw_prom_alloc(struct ipw_priv *priv)
11537{
11538 int rc = 0;
11539
11540 if (priv->prom_net_dev)
11541 return -EPERM;
11542
11543 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11544 if (priv->prom_net_dev == NULL)
11545 return -ENOMEM;
11546
11547 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11548 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11549 priv->prom_priv->priv = priv;
11550
11551 strcpy(priv->prom_net_dev->name, "rtap%d");
Daniel Drake3f2eeac2008-04-02 20:33:54 +010011552 memcpy(priv->prom_net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
Zhu Yid685b8c2006-04-13 17:20:27 +080011553
11554 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011555 priv->prom_net_dev->netdev_ops = &ipw_prom_netdev_ops;
Zhu Yid685b8c2006-04-13 17:20:27 +080011556
11557 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
Masakazu Mokuno229ce3a2008-05-14 14:16:50 +090011558 SET_NETDEV_DEV(priv->prom_net_dev, &priv->pci_dev->dev);
Zhu Yid685b8c2006-04-13 17:20:27 +080011559
11560 rc = register_netdev(priv->prom_net_dev);
11561 if (rc) {
11562 free_ieee80211(priv->prom_net_dev);
11563 priv->prom_net_dev = NULL;
11564 return rc;
11565 }
11566
11567 return 0;
11568}
11569
11570static void ipw_prom_free(struct ipw_priv *priv)
11571{
11572 if (!priv->prom_net_dev)
11573 return;
11574
11575 unregister_netdev(priv->prom_net_dev);
11576 free_ieee80211(priv->prom_net_dev);
11577
11578 priv->prom_net_dev = NULL;
11579}
11580
11581#endif
11582
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011583static const struct net_device_ops ipw_netdev_ops = {
11584 .ndo_init = ipw_net_init,
11585 .ndo_open = ipw_net_open,
11586 .ndo_stop = ipw_net_stop,
11587 .ndo_set_multicast_list = ipw_net_set_multicast_list,
11588 .ndo_set_mac_address = ipw_net_set_mac_address,
11589 .ndo_start_xmit = ieee80211_xmit,
11590 .ndo_change_mtu = ieee80211_change_mtu,
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011591 .ndo_validate_addr = eth_validate_addr,
11592};
Zhu Yid685b8c2006-04-13 17:20:27 +080011593
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011594static int __devinit ipw_pci_probe(struct pci_dev *pdev,
11595 const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011596{
11597 int err = 0;
11598 struct net_device *net_dev;
11599 void __iomem *base;
11600 u32 length, val;
11601 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011602 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011603
11604 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11605 if (net_dev == NULL) {
11606 err = -ENOMEM;
11607 goto out;
11608 }
11609
11610 priv = ieee80211_priv(net_dev);
11611 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011612
James Ketrenos43f66a62005-03-25 12:31:53 -060011613 priv->net_dev = net_dev;
11614 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011615 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011616 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011617 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011618 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11619 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011620
Zhu Yi46441512006-01-24 16:37:59 +080011621 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011622 if (pci_enable_device(pdev)) {
11623 err = -ENODEV;
11624 goto out_free_ieee80211;
11625 }
11626
11627 pci_set_master(pdev);
11628
Yang Hongyang284901a2009-04-06 19:01:15 -070011629 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
Jeff Garzikbf794512005-07-31 13:07:26 -040011630 if (!err)
Yang Hongyang284901a2009-04-06 19:01:15 -070011631 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
James Ketrenos43f66a62005-03-25 12:31:53 -060011632 if (err) {
11633 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11634 goto out_pci_disable_device;
11635 }
11636
11637 pci_set_drvdata(pdev, priv);
11638
11639 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011640 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011641 goto out_pci_disable_device;
11642
Jeff Garzikbf794512005-07-31 13:07:26 -040011643 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011644 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011645 pci_read_config_dword(pdev, 0x40, &val);
11646 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011647 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011648
James Ketrenos43f66a62005-03-25 12:31:53 -060011649 length = pci_resource_len(pdev, 0);
11650 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011651
Arjan van de Ven275f1652008-10-20 21:42:39 -070011652 base = pci_ioremap_bar(pdev, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -060011653 if (!base) {
11654 err = -ENODEV;
11655 goto out_pci_release_regions;
11656 }
11657
11658 priv->hw_base = base;
11659 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11660 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11661
11662 err = ipw_setup_deferred_work(priv);
11663 if (err) {
11664 IPW_ERROR("Unable to setup deferred work\n");
11665 goto out_iounmap;
11666 }
11667
James Ketrenosb095c382005-08-24 22:04:42 -050011668 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011669
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011670 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011671 if (err) {
11672 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11673 goto out_destroy_workqueue;
11674 }
11675
James Ketrenos43f66a62005-03-25 12:31:53 -060011676 SET_NETDEV_DEV(net_dev, &pdev->dev);
11677
Zhu Yi46441512006-01-24 16:37:59 +080011678 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011679
James Ketrenos43f66a62005-03-25 12:31:53 -060011680 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11681 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011682 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011683
Zhu Yie43e3c12006-04-13 17:20:45 +080011684#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011685 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011686 priv->ieee->handle_probe_response = ipw_handle_beacon;
11687 priv->ieee->handle_beacon = ipw_handle_probe_response;
11688 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011689#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011690
James Ketrenosc848d0a2005-08-24 21:56:24 -050011691 priv->ieee->perfect_rssi = -20;
11692 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011693
Stephen Hemminger44e9ad02009-03-20 19:36:41 +000011694 net_dev->netdev_ops = &ipw_netdev_ops;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011695 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011696 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011697 net_dev->wireless_handlers = &ipw_wx_handler_def;
11698 net_dev->ethtool_ops = &ipw_ethtool_ops;
11699 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011700 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011701 net_dev->mem_start = pci_resource_start(pdev, 0);
11702 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11703
11704 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11705 if (err) {
11706 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011707 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011708 goto out_release_irq;
11709 }
11710
Zhu Yi46441512006-01-24 16:37:59 +080011711 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011712 err = register_netdev(net_dev);
11713 if (err) {
11714 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011715 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011716 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011717
Zhu Yid685b8c2006-04-13 17:20:27 +080011718#ifdef CONFIG_IPW2200_PROMISCUOUS
11719 if (rtap_iface) {
11720 err = ipw_prom_alloc(priv);
11721 if (err) {
11722 IPW_ERROR("Failed to register promiscuous network "
11723 "device (error %d).\n", err);
11724 unregister_netdev(priv->net_dev);
11725 goto out_remove_sysfs;
11726 }
11727 }
11728#endif
11729
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011730 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11731 "channels, %d 802.11a channels)\n",
11732 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11733 priv->ieee->geo.a_channels);
11734
James Ketrenos43f66a62005-03-25 12:31:53 -060011735 return 0;
11736
James Ketrenosa613bff2005-08-24 21:43:11 -050011737 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011738 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011739 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011740 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011741 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011742 destroy_workqueue(priv->workqueue);
11743 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011744 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011745 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011746 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011747 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011748 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011749 pci_disable_device(pdev);
11750 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011751 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011752 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011753 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011754 return err;
11755}
11756
Adrian Bunk2ef19e62007-12-11 23:20:22 +010011757static void __devexit ipw_pci_remove(struct pci_dev *pdev)
James Ketrenos43f66a62005-03-25 12:31:53 -060011758{
11759 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011760 struct list_head *p, *q;
11761 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011762
James Ketrenos43f66a62005-03-25 12:31:53 -060011763 if (!priv)
11764 return;
11765
Zhu Yi46441512006-01-24 16:37:59 +080011766 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011767
James Ketrenosafbf30a2005-08-25 00:05:33 -050011768 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011769 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011770 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11771
Zhu Yi46441512006-01-24 16:37:59 +080011772 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011773
11774 unregister_netdev(priv->net_dev);
11775
11776 if (priv->rxq) {
11777 ipw_rx_queue_free(priv, priv->rxq);
11778 priv->rxq = NULL;
11779 }
11780 ipw_tx_queue_free(priv);
11781
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011782 if (priv->cmdlog) {
11783 kfree(priv->cmdlog);
11784 priv->cmdlog = NULL;
11785 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011786 /* ipw_down will ensure that there is no more pending work
11787 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011788 cancel_delayed_work(&priv->adhoc_check);
11789 cancel_delayed_work(&priv->gather_stats);
11790 cancel_delayed_work(&priv->request_scan);
Dan Williamsea177302008-06-02 17:51:23 -040011791 cancel_delayed_work(&priv->request_direct_scan);
11792 cancel_delayed_work(&priv->request_passive_scan);
Dan Williams0b531672007-10-09 13:55:24 -040011793 cancel_delayed_work(&priv->scan_event);
James Ketrenosa613bff2005-08-24 21:43:11 -050011794 cancel_delayed_work(&priv->rf_kill);
11795 cancel_delayed_work(&priv->scan_check);
11796 destroy_workqueue(priv->workqueue);
11797 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011798
James Ketrenosafbf30a2005-08-25 00:05:33 -050011799 /* Free MAC hash list for ADHOC */
11800 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11801 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011802 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011803 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011804 }
11805 }
11806
Jesper Juhl8f760782006-06-27 02:55:06 -070011807 kfree(priv->error);
11808 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011809
Zhu Yid685b8c2006-04-13 17:20:27 +080011810#ifdef CONFIG_IPW2200_PROMISCUOUS
11811 ipw_prom_free(priv);
11812#endif
11813
James Ketrenos43f66a62005-03-25 12:31:53 -060011814 free_irq(pdev->irq, priv);
11815 iounmap(priv->hw_base);
11816 pci_release_regions(pdev);
11817 pci_disable_device(pdev);
11818 pci_set_drvdata(pdev, NULL);
11819 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011820 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011821}
11822
James Ketrenos43f66a62005-03-25 12:31:53 -060011823#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011824static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011825{
11826 struct ipw_priv *priv = pci_get_drvdata(pdev);
11827 struct net_device *dev = priv->net_dev;
11828
11829 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11830
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011831 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011832 ipw_down(priv);
11833
11834 /* Remove the PRESENT state of the device */
11835 netif_device_detach(dev);
11836
James Ketrenos43f66a62005-03-25 12:31:53 -060011837 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011838 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011839 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011840
Dan Williamsc3d72b92009-02-11 13:26:06 -050011841 priv->suspend_at = get_seconds();
11842
James Ketrenos43f66a62005-03-25 12:31:53 -060011843 return 0;
11844}
11845
11846static int ipw_pci_resume(struct pci_dev *pdev)
11847{
11848 struct ipw_priv *priv = pci_get_drvdata(pdev);
11849 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011850 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011851 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011852
James Ketrenos43f66a62005-03-25 12:31:53 -060011853 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11854
James Ketrenosea2b26e2005-08-24 21:25:16 -050011855 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011856 err = pci_enable_device(pdev);
11857 if (err) {
11858 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11859 dev->name);
11860 return err;
11861 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011862 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011863
James Ketrenos43f66a62005-03-25 12:31:53 -060011864 /*
11865 * Suspend/Resume resets the PCI configuration space, so we have to
11866 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11867 * from interfering with C3 CPU state. pci_restore_state won't help
11868 * here since it only restores the first 64 bytes pci config header.
11869 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011870 pci_read_config_dword(pdev, 0x40, &val);
11871 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011872 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11873
11874 /* Set the device back into the PRESENT state; this will also wake
11875 * the queue of needed */
11876 netif_device_attach(dev);
11877
Dan Williamsc3d72b92009-02-11 13:26:06 -050011878 priv->suspend_time = get_seconds() - priv->suspend_at;
11879
James Ketrenos43f66a62005-03-25 12:31:53 -060011880 /* Bring the device back up */
11881 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011882
James Ketrenos43f66a62005-03-25 12:31:53 -060011883 return 0;
11884}
11885#endif
11886
Zhu Yic8c22c92006-08-21 11:38:39 +080011887static void ipw_pci_shutdown(struct pci_dev *pdev)
11888{
11889 struct ipw_priv *priv = pci_get_drvdata(pdev);
11890
11891 /* Take down the device; powers it off, etc. */
11892 ipw_down(priv);
11893
11894 pci_disable_device(pdev);
11895}
11896
James Ketrenos43f66a62005-03-25 12:31:53 -060011897/* driver initialization stuff */
11898static struct pci_driver ipw_driver = {
11899 .name = DRV_NAME,
11900 .id_table = card_ids,
11901 .probe = ipw_pci_probe,
11902 .remove = __devexit_p(ipw_pci_remove),
11903#ifdef CONFIG_PM
11904 .suspend = ipw_pci_suspend,
11905 .resume = ipw_pci_resume,
11906#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011907 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011908};
11909
11910static int __init ipw_init(void)
11911{
11912 int ret;
11913
11914 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11915 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11916
Jeff Garzik29917622006-08-19 17:48:59 -040011917 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011918 if (ret) {
11919 IPW_ERROR("Unable to initialize PCI module\n");
11920 return ret;
11921 }
11922
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011923 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011924 if (ret) {
11925 IPW_ERROR("Unable to create driver sysfs file\n");
11926 pci_unregister_driver(&ipw_driver);
11927 return ret;
11928 }
11929
11930 return ret;
11931}
11932
11933static void __exit ipw_exit(void)
11934{
11935 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11936 pci_unregister_driver(&ipw_driver);
11937}
11938
11939module_param(disable, int, 0444);
11940MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11941
11942module_param(associate, int, 0444);
Tim Gardner5c7f9b72008-10-14 10:38:03 -060011943MODULE_PARM_DESC(associate, "auto associate when scanning (default off)");
James Ketrenos43f66a62005-03-25 12:31:53 -060011944
11945module_param(auto_create, int, 0444);
11946MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11947
Reinette Chatre21f8a732009-08-18 10:25:05 -070011948module_param_named(led, led_support, int, 0444);
Niels de Vos61a2d072008-07-31 00:07:23 -070011949MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)");
James Ketrenosa613bff2005-08-24 21:43:11 -050011950
James Ketrenos43f66a62005-03-25 12:31:53 -060011951module_param(debug, int, 0444);
11952MODULE_PARM_DESC(debug, "debug output mask");
11953
Reinette Chatre21f8a732009-08-18 10:25:05 -070011954module_param_named(channel, default_channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011955MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011956
Zhu Yid685b8c2006-04-13 17:20:27 +080011957#ifdef CONFIG_IPW2200_PROMISCUOUS
11958module_param(rtap_iface, int, 0444);
11959MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11960#endif
11961
Zhu Yie43e3c12006-04-13 17:20:45 +080011962#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011963module_param(qos_enable, int, 0444);
11964MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011965
James Ketrenosb095c382005-08-24 22:04:42 -050011966module_param(qos_burst_enable, int, 0444);
11967MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11968
11969module_param(qos_no_ack_mask, int, 0444);
11970MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11971
11972module_param(burst_duration_CCK, int, 0444);
11973MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11974
11975module_param(burst_duration_OFDM, int, 0444);
11976MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011977#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011978
11979#ifdef CONFIG_IPW2200_MONITOR
Reinette Chatre21f8a732009-08-18 10:25:05 -070011980module_param_named(mode, network_mode, int, 0444);
James Ketrenos43f66a62005-03-25 12:31:53 -060011981MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
11982#else
Reinette Chatre21f8a732009-08-18 10:25:05 -070011983module_param_named(mode, network_mode, int, 0444);
James Ketrenos43f66a62005-03-25 12:31:53 -060011984MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
11985#endif
11986
Zhu Yi810dabd2006-01-24 16:36:59 +080011987module_param(bt_coexist, int, 0444);
11988MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
11989
James Ketrenosb095c382005-08-24 22:04:42 -050011990module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080011991MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050011992
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011993module_param(cmdlog, int, 0444);
11994MODULE_PARM_DESC(cmdlog,
11995 "allocate a ring buffer for logging firmware commands");
11996
Zhu Yi4bfdb912006-01-24 16:37:16 +080011997module_param(roaming, int, 0444);
11998MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
11999
Zhu Yid2b83e12006-04-13 17:19:36 +080012000module_param(antenna, int, 0444);
12001MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
12002
James Ketrenos43f66a62005-03-25 12:31:53 -060012003module_exit(ipw_exit);
12004module_init(ipw_init);