blob: b2e144b7f4a0a2dc1ae2c1c5dd71d1b7eead5017 [file] [log] [blame]
James Ketrenos43f66a62005-03-25 12:31:53 -06001/******************************************************************************
Jeff Garzikbf794512005-07-31 13:07:26 -04002
Zhu Yi171e7b22006-02-15 07:17:56 +08003 Copyright(c) 2003 - 2006 Intel Corporation. All rights reserved.
James Ketrenos43f66a62005-03-25 12:31:53 -06004
5 802.11 status code portion of this file from ethereal-0.10.6:
6 Copyright 2000, Axis Communications AB
7 Ethereal - Network traffic analyzer
8 By Gerald Combs <gerald@ethereal.com>
9 Copyright 1998 Gerald Combs
10
Jeff Garzikbf794512005-07-31 13:07:26 -040011 This program is free software; you can redistribute it and/or modify it
12 under the terms of version 2 of the GNU General Public License as
James Ketrenos43f66a62005-03-25 12:31:53 -060013 published by the Free Software Foundation.
Jeff Garzikbf794512005-07-31 13:07:26 -040014
15 This program is distributed in the hope that it will be useful, but WITHOUT
16 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
James Ketrenos43f66a62005-03-25 12:31:53 -060018 more details.
Jeff Garzikbf794512005-07-31 13:07:26 -040019
James Ketrenos43f66a62005-03-25 12:31:53 -060020 You should have received a copy of the GNU General Public License along with
Jeff Garzikbf794512005-07-31 13:07:26 -040021 this program; if not, write to the Free Software Foundation, Inc., 59
James Ketrenos43f66a62005-03-25 12:31:53 -060022 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
Jeff Garzikbf794512005-07-31 13:07:26 -040023
James Ketrenos43f66a62005-03-25 12:31:53 -060024 The full GNU General Public License is included in this distribution in the
25 file called LICENSE.
Jeff Garzikbf794512005-07-31 13:07:26 -040026
James Ketrenos43f66a62005-03-25 12:31:53 -060027 Contact Information:
28 James P. Ketrenos <ipw2100-admin@linux.intel.com>
29 Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30
31******************************************************************************/
32
33#include "ipw2200.h"
Olaf Hering733482e2005-11-08 21:34:55 -080034#include <linux/version.h>
James Ketrenos43f66a62005-03-25 12:31:53 -060035
Zhu Yiae4af612006-04-13 17:20:34 +080036
37#ifndef KBUILD_EXTMOD
38#define VK "k"
39#else
40#define VK
41#endif
42
43#ifdef CONFIG_IPW2200_DEBUG
44#define VD "d"
45#else
46#define VD
47#endif
48
49#ifdef CONFIG_IPW2200_MONITOR
50#define VM "m"
51#else
52#define VM
53#endif
54
55#ifdef CONFIG_IPW2200_PROMISCUOUS
56#define VP "p"
57#else
58#define VP
59#endif
60
Zhu Yi459d4082006-04-13 17:21:00 +080061#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yiae4af612006-04-13 17:20:34 +080062#define VR "r"
63#else
64#define VR
65#endif
66
67#ifdef CONFIG_IPW2200_QOS
68#define VQ "q"
69#else
70#define VQ
71#endif
72
Zhu Yi8b5f9172006-08-21 11:39:13 +080073#define IPW2200_VERSION "1.1.4" VK VD VM VP VR VQ
James Ketrenos43f66a62005-03-25 12:31:53 -060074#define DRV_DESCRIPTION "Intel(R) PRO/Wireless 2200/2915 Network Driver"
Zhu Yi171e7b22006-02-15 07:17:56 +080075#define DRV_COPYRIGHT "Copyright(c) 2003-2006 Intel Corporation"
James Ketrenos43f66a62005-03-25 12:31:53 -060076#define DRV_VERSION IPW2200_VERSION
77
James Ketrenosb095c382005-08-24 22:04:42 -050078#define ETH_P_80211_STATS (ETH_P_80211_RAW + 1)
79
James Ketrenos43f66a62005-03-25 12:31:53 -060080MODULE_DESCRIPTION(DRV_DESCRIPTION);
81MODULE_VERSION(DRV_VERSION);
82MODULE_AUTHOR(DRV_COPYRIGHT);
83MODULE_LICENSE("GPL");
84
James Ketrenosf6c5cb72005-08-25 00:39:09 -050085static int cmdlog = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060086static int debug = 0;
87static int channel = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060088static int mode = 0;
89
90static u32 ipw_debug_level;
91static int associate = 1;
92static int auto_create = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -050093static int led = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060094static int disable = 0;
Zhu Yi810dabd2006-01-24 16:36:59 +080095static int bt_coexist = 0;
Zhu Yibde37d02006-01-24 16:38:08 +080096static int hwcrypto = 0;
Zhu Yi4bfdb912006-01-24 16:37:16 +080097static int roaming = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -060098static const char ipw_modes[] = {
99 'a', 'b', 'g', '?'
100};
Zhu Yid2b83e12006-04-13 17:19:36 +0800101static int antenna = CFG_SYS_ANTENNA_BOTH;
James Ketrenos43f66a62005-03-25 12:31:53 -0600102
Zhu Yid685b8c2006-04-13 17:20:27 +0800103#ifdef CONFIG_IPW2200_PROMISCUOUS
104static int rtap_iface = 0; /* def: 0 -- do not create rtap interface */
105#endif
106
107
Zhu Yie43e3c12006-04-13 17:20:45 +0800108#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -0500109static int qos_enable = 0;
110static int qos_burst_enable = 0;
111static int qos_no_ack_mask = 0;
112static int burst_duration_CCK = 0;
113static int burst_duration_OFDM = 0;
114
115static struct ieee80211_qos_parameters def_qos_parameters_OFDM = {
116 {QOS_TX0_CW_MIN_OFDM, QOS_TX1_CW_MIN_OFDM, QOS_TX2_CW_MIN_OFDM,
117 QOS_TX3_CW_MIN_OFDM},
118 {QOS_TX0_CW_MAX_OFDM, QOS_TX1_CW_MAX_OFDM, QOS_TX2_CW_MAX_OFDM,
119 QOS_TX3_CW_MAX_OFDM},
120 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
121 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
122 {QOS_TX0_TXOP_LIMIT_OFDM, QOS_TX1_TXOP_LIMIT_OFDM,
123 QOS_TX2_TXOP_LIMIT_OFDM, QOS_TX3_TXOP_LIMIT_OFDM}
124};
125
126static struct ieee80211_qos_parameters def_qos_parameters_CCK = {
127 {QOS_TX0_CW_MIN_CCK, QOS_TX1_CW_MIN_CCK, QOS_TX2_CW_MIN_CCK,
128 QOS_TX3_CW_MIN_CCK},
129 {QOS_TX0_CW_MAX_CCK, QOS_TX1_CW_MAX_CCK, QOS_TX2_CW_MAX_CCK,
130 QOS_TX3_CW_MAX_CCK},
131 {QOS_TX0_AIFS, QOS_TX1_AIFS, QOS_TX2_AIFS, QOS_TX3_AIFS},
132 {QOS_TX0_ACM, QOS_TX1_ACM, QOS_TX2_ACM, QOS_TX3_ACM},
133 {QOS_TX0_TXOP_LIMIT_CCK, QOS_TX1_TXOP_LIMIT_CCK, QOS_TX2_TXOP_LIMIT_CCK,
134 QOS_TX3_TXOP_LIMIT_CCK}
135};
136
137static struct ieee80211_qos_parameters def_parameters_OFDM = {
138 {DEF_TX0_CW_MIN_OFDM, DEF_TX1_CW_MIN_OFDM, DEF_TX2_CW_MIN_OFDM,
139 DEF_TX3_CW_MIN_OFDM},
140 {DEF_TX0_CW_MAX_OFDM, DEF_TX1_CW_MAX_OFDM, DEF_TX2_CW_MAX_OFDM,
141 DEF_TX3_CW_MAX_OFDM},
142 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
143 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
144 {DEF_TX0_TXOP_LIMIT_OFDM, DEF_TX1_TXOP_LIMIT_OFDM,
145 DEF_TX2_TXOP_LIMIT_OFDM, DEF_TX3_TXOP_LIMIT_OFDM}
146};
147
148static struct ieee80211_qos_parameters def_parameters_CCK = {
149 {DEF_TX0_CW_MIN_CCK, DEF_TX1_CW_MIN_CCK, DEF_TX2_CW_MIN_CCK,
150 DEF_TX3_CW_MIN_CCK},
151 {DEF_TX0_CW_MAX_CCK, DEF_TX1_CW_MAX_CCK, DEF_TX2_CW_MAX_CCK,
152 DEF_TX3_CW_MAX_CCK},
153 {DEF_TX0_AIFS, DEF_TX1_AIFS, DEF_TX2_AIFS, DEF_TX3_AIFS},
154 {DEF_TX0_ACM, DEF_TX1_ACM, DEF_TX2_ACM, DEF_TX3_ACM},
155 {DEF_TX0_TXOP_LIMIT_CCK, DEF_TX1_TXOP_LIMIT_CCK, DEF_TX2_TXOP_LIMIT_CCK,
156 DEF_TX3_TXOP_LIMIT_CCK}
157};
158
159static u8 qos_oui[QOS_OUI_LEN] = { 0x00, 0x50, 0xF2 };
160
161static int from_priority_to_tx_queue[] = {
162 IPW_TX_QUEUE_1, IPW_TX_QUEUE_2, IPW_TX_QUEUE_2, IPW_TX_QUEUE_1,
163 IPW_TX_QUEUE_3, IPW_TX_QUEUE_3, IPW_TX_QUEUE_4, IPW_TX_QUEUE_4
164};
165
166static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv);
167
168static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
169 *qos_param);
170static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
171 *qos_param);
Zhu Yie43e3c12006-04-13 17:20:45 +0800172#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -0500173
Benoit Boissinot97a78ca2005-09-15 17:30:28 +0000174static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev);
James Ketrenosb095c382005-08-24 22:04:42 -0500175static void ipw_remove_current_network(struct ipw_priv *priv);
James Ketrenos43f66a62005-03-25 12:31:53 -0600176static void ipw_rx(struct ipw_priv *priv);
Jeff Garzikbf794512005-07-31 13:07:26 -0400177static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -0600178 struct clx2_tx_queue *txq, int qindex);
179static int ipw_queue_reset(struct ipw_priv *priv);
180
181static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
182 int len, int sync);
183
184static void ipw_tx_queue_free(struct ipw_priv *);
185
186static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *);
187static void ipw_rx_queue_free(struct ipw_priv *, struct ipw_rx_queue *);
188static void ipw_rx_queue_replenish(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600189static int ipw_up(struct ipw_priv *);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500190static void ipw_bg_up(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600191static void ipw_down(struct ipw_priv *);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500192static void ipw_bg_down(void *);
James Ketrenos43f66a62005-03-25 12:31:53 -0600193static int ipw_config(struct ipw_priv *);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400194static int init_supported_rates(struct ipw_priv *priv,
195 struct ipw_supported_rates *prates);
James Ketrenosb095c382005-08-24 22:04:42 -0500196static void ipw_set_hwcrypto_keys(struct ipw_priv *);
197static void ipw_send_wep_keys(struct ipw_priv *, int);
James Ketrenos43f66a62005-03-25 12:31:53 -0600198
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500199static int snprint_line(char *buf, size_t count,
200 const u8 * data, u32 len, u32 ofs)
James Ketrenos43f66a62005-03-25 12:31:53 -0600201{
202 int out, i, j, l;
203 char c;
Jeff Garzikbf794512005-07-31 13:07:26 -0400204
James Ketrenos43f66a62005-03-25 12:31:53 -0600205 out = snprintf(buf, count, "%08X", ofs);
206
207 for (l = 0, i = 0; i < 2; i++) {
208 out += snprintf(buf + out, count - out, " ");
Jeff Garzikbf794512005-07-31 13:07:26 -0400209 for (j = 0; j < 8 && l < len; j++, l++)
210 out += snprintf(buf + out, count - out, "%02X ",
James Ketrenos43f66a62005-03-25 12:31:53 -0600211 data[(i * 8 + j)]);
212 for (; j < 8; j++)
213 out += snprintf(buf + out, count - out, " ");
214 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400215
James Ketrenos43f66a62005-03-25 12:31:53 -0600216 out += snprintf(buf + out, count - out, " ");
217 for (l = 0, i = 0; i < 2; i++) {
218 out += snprintf(buf + out, count - out, " ");
219 for (j = 0; j < 8 && l < len; j++, l++) {
220 c = data[(i * 8 + j)];
221 if (!isascii(c) || !isprint(c))
222 c = '.';
Jeff Garzikbf794512005-07-31 13:07:26 -0400223
James Ketrenos43f66a62005-03-25 12:31:53 -0600224 out += snprintf(buf + out, count - out, "%c", c);
225 }
226
227 for (; j < 8; j++)
228 out += snprintf(buf + out, count - out, " ");
229 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400230
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500231 return out;
James Ketrenos43f66a62005-03-25 12:31:53 -0600232}
233
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400234static void printk_buf(int level, const u8 * data, u32 len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600235{
236 char line[81];
237 u32 ofs = 0;
238 if (!(ipw_debug_level & level))
239 return;
240
241 while (len) {
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500242 snprint_line(line, sizeof(line), &data[ofs],
243 min(len, 16U), ofs);
244 printk(KERN_DEBUG "%s\n", line);
James Ketrenos43f66a62005-03-25 12:31:53 -0600245 ofs += 16;
246 len -= min(len, 16U);
247 }
248}
249
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500250static int snprintk_buf(u8 * output, size_t size, const u8 * data, size_t len)
251{
252 size_t out = size;
253 u32 ofs = 0;
254 int total = 0;
255
256 while (size && len) {
257 out = snprint_line(output, size, &data[ofs],
258 min_t(size_t, len, 16U), ofs);
259
260 ofs += 16;
261 output += out;
262 size -= out;
263 len -= min_t(size_t, len, 16U);
264 total += out;
265 }
266 return total;
267}
268
Zhu Yic8fe6672006-01-24 16:36:36 +0800269/* alias for 32-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600270static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg);
271#define ipw_read_reg32(a, b) _ipw_read_reg32(a, b)
272
Zhu Yic8fe6672006-01-24 16:36:36 +0800273/* alias for 8-bit indirect read (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600274static u8 _ipw_read_reg8(struct ipw_priv *ipw, u32 reg);
275#define ipw_read_reg8(a, b) _ipw_read_reg8(a, b)
276
Zhu Yic8fe6672006-01-24 16:36:36 +0800277/* 8-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600278static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value);
279static inline void ipw_write_reg8(struct ipw_priv *a, u32 b, u8 c)
280{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400281 IPW_DEBUG_IO("%s %d: write_indirect8(0x%08X, 0x%08X)\n", __FILE__,
282 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600283 _ipw_write_reg8(a, b, c);
284}
285
Zhu Yic8fe6672006-01-24 16:36:36 +0800286/* 16-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600287static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value);
288static inline void ipw_write_reg16(struct ipw_priv *a, u32 b, u16 c)
289{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400290 IPW_DEBUG_IO("%s %d: write_indirect16(0x%08X, 0x%08X)\n", __FILE__,
291 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600292 _ipw_write_reg16(a, b, c);
293}
294
Zhu Yic8fe6672006-01-24 16:36:36 +0800295/* 32-bit indirect write (for SRAM/reg above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600296static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value);
297static inline void ipw_write_reg32(struct ipw_priv *a, u32 b, u32 c)
298{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400299 IPW_DEBUG_IO("%s %d: write_indirect32(0x%08X, 0x%08X)\n", __FILE__,
300 __LINE__, (u32) (b), (u32) (c));
James Ketrenos43f66a62005-03-25 12:31:53 -0600301 _ipw_write_reg32(a, b, c);
302}
303
Zhu Yic8fe6672006-01-24 16:36:36 +0800304/* 8-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600305#define _ipw_write8(ipw, ofs, val) writeb((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800306
307/* 8-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600308#define ipw_write8(ipw, ofs, val) \
309 IPW_DEBUG_IO("%s %d: write_direct8(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
310 _ipw_write8(ipw, ofs, val)
311
Zhu Yic8fe6672006-01-24 16:36:36 +0800312/* 16-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600313#define _ipw_write16(ipw, ofs, val) writew((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800314
315/* 16-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600316#define ipw_write16(ipw, ofs, val) \
317 IPW_DEBUG_IO("%s %d: write_direct16(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
318 _ipw_write16(ipw, ofs, val)
319
Zhu Yic8fe6672006-01-24 16:36:36 +0800320/* 32-bit direct write (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600321#define _ipw_write32(ipw, ofs, val) writel((val), (ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800322
323/* 32-bit direct write (for low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600324#define ipw_write32(ipw, ofs, val) \
325 IPW_DEBUG_IO("%s %d: write_direct32(0x%08X, 0x%08X)\n", __FILE__, __LINE__, (u32)(ofs), (u32)(val)); \
326 _ipw_write32(ipw, ofs, val)
327
Zhu Yic8fe6672006-01-24 16:36:36 +0800328/* 8-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600329#define _ipw_read8(ipw, ofs) readb((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800330
331/* 8-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400332static inline u8 __ipw_read8(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
333{
334 IPW_DEBUG_IO("%s %d: read_direct8(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600335 return _ipw_read8(ipw, ofs);
336}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400337
Zhu Yic8fe6672006-01-24 16:36:36 +0800338/* alias to 8-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600339#define ipw_read8(ipw, ofs) __ipw_read8(__FILE__, __LINE__, ipw, ofs)
340
Zhu Yic8fe6672006-01-24 16:36:36 +0800341/* 16-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600342#define _ipw_read16(ipw, ofs) readw((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800343
344/* 16-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400345static inline u16 __ipw_read16(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
346{
347 IPW_DEBUG_IO("%s %d: read_direct16(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600348 return _ipw_read16(ipw, ofs);
349}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400350
Zhu Yic8fe6672006-01-24 16:36:36 +0800351/* alias to 16-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600352#define ipw_read16(ipw, ofs) __ipw_read16(__FILE__, __LINE__, ipw, ofs)
353
Zhu Yic8fe6672006-01-24 16:36:36 +0800354/* 32-bit direct read (low 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600355#define _ipw_read32(ipw, ofs) readl((ipw)->hw_base + (ofs))
Zhu Yic8fe6672006-01-24 16:36:36 +0800356
357/* 32-bit direct read (low 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400358static inline u32 __ipw_read32(char *f, u32 l, struct ipw_priv *ipw, u32 ofs)
359{
360 IPW_DEBUG_IO("%s %d: read_direct32(0x%08X)\n", f, l, (u32) (ofs));
James Ketrenos43f66a62005-03-25 12:31:53 -0600361 return _ipw_read32(ipw, ofs);
362}
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400363
Zhu Yic8fe6672006-01-24 16:36:36 +0800364/* alias to 32-bit direct read (low 4K of SRAM/regs), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600365#define ipw_read32(ipw, ofs) __ipw_read32(__FILE__, __LINE__, ipw, ofs)
366
Zhu Yic8fe6672006-01-24 16:36:36 +0800367/* multi-byte read (above 4K), with debug wrapper */
James Ketrenos43f66a62005-03-25 12:31:53 -0600368static void _ipw_read_indirect(struct ipw_priv *, u32, u8 *, int);
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500369static inline void __ipw_read_indirect(const char *f, int l,
370 struct ipw_priv *a, u32 b, u8 * c, int d)
371{
372 IPW_DEBUG_IO("%s %d: read_indirect(0x%08X) %d bytes\n", f, l, (u32) (b),
373 d);
374 _ipw_read_indirect(a, b, c, d);
375}
376
Zhu Yic8fe6672006-01-24 16:36:36 +0800377/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
James Ketrenosf6c5cb72005-08-25 00:39:09 -0500378#define ipw_read_indirect(a, b, c, d) __ipw_read_indirect(__FILE__, __LINE__, a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600379
Zhu Yic8fe6672006-01-24 16:36:36 +0800380/* alias to multi-byte read (SRAM/regs above 4K), with debug wrapper */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400381static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * data,
382 int num);
James Ketrenos43f66a62005-03-25 12:31:53 -0600383#define ipw_write_indirect(a, b, c, d) \
384 IPW_DEBUG_IO("%s %d: write_indirect(0x%08X) %d bytes\n", __FILE__, __LINE__, (u32)(b), d); \
James Ketrenosafbf30a2005-08-25 00:05:33 -0500385 _ipw_write_indirect(a, b, c, d)
James Ketrenos43f66a62005-03-25 12:31:53 -0600386
Zhu Yic8fe6672006-01-24 16:36:36 +0800387/* 32-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400388static void _ipw_write_reg32(struct ipw_priv *priv, u32 reg, u32 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600389{
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400390 IPW_DEBUG_IO(" %p : reg = 0x%8X : value = 0x%8X\n", priv, reg, value);
James Ketrenosb095c382005-08-24 22:04:42 -0500391 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
392 _ipw_write32(priv, IPW_INDIRECT_DATA, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600393}
394
Zhu Yic8fe6672006-01-24 16:36:36 +0800395/* 8-bit indirect write (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600396static void _ipw_write_reg8(struct ipw_priv *priv, u32 reg, u8 value)
397{
Zhu Yi2638bc32006-01-24 16:37:52 +0800398 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800399 u32 dif_len = reg - aligned_addr;
400
James Ketrenos43f66a62005-03-25 12:31:53 -0600401 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800402 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
403 _ipw_write8(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600404}
405
Zhu Yic8fe6672006-01-24 16:36:36 +0800406/* 16-bit indirect write (above 4K) */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400407static void _ipw_write_reg16(struct ipw_priv *priv, u32 reg, u16 value)
James Ketrenos43f66a62005-03-25 12:31:53 -0600408{
Zhu Yi2638bc32006-01-24 16:37:52 +0800409 u32 aligned_addr = reg & IPW_INDIRECT_ADDR_MASK; /* dword align */
Zhu Yic8fe6672006-01-24 16:36:36 +0800410 u32 dif_len = (reg - aligned_addr) & (~0x1ul);
411
James Ketrenos43f66a62005-03-25 12:31:53 -0600412 IPW_DEBUG_IO(" reg = 0x%8X : value = 0x%8X\n", reg, value);
Zhu Yic8fe6672006-01-24 16:36:36 +0800413 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
414 _ipw_write16(priv, IPW_INDIRECT_DATA + dif_len, value);
James Ketrenos43f66a62005-03-25 12:31:53 -0600415}
416
Zhu Yic8fe6672006-01-24 16:36:36 +0800417/* 8-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600418static u8 _ipw_read_reg8(struct ipw_priv *priv, u32 reg)
419{
420 u32 word;
James Ketrenosb095c382005-08-24 22:04:42 -0500421 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg & IPW_INDIRECT_ADDR_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -0600422 IPW_DEBUG_IO(" reg = 0x%8X : \n", reg);
James Ketrenosb095c382005-08-24 22:04:42 -0500423 word = _ipw_read32(priv, IPW_INDIRECT_DATA);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400424 return (word >> ((reg & 0x3) * 8)) & 0xff;
James Ketrenos43f66a62005-03-25 12:31:53 -0600425}
426
Zhu Yic8fe6672006-01-24 16:36:36 +0800427/* 32-bit indirect read (above 4K) */
James Ketrenos43f66a62005-03-25 12:31:53 -0600428static u32 _ipw_read_reg32(struct ipw_priv *priv, u32 reg)
429{
430 u32 value;
431
432 IPW_DEBUG_IO("%p : reg = 0x%08x\n", priv, reg);
433
James Ketrenosb095c382005-08-24 22:04:42 -0500434 _ipw_write32(priv, IPW_INDIRECT_ADDR, reg);
435 value = _ipw_read32(priv, IPW_INDIRECT_DATA);
James Ketrenos43f66a62005-03-25 12:31:53 -0600436 IPW_DEBUG_IO(" reg = 0x%4X : value = 0x%4x \n", reg, value);
437 return value;
438}
439
Zhu Yic8fe6672006-01-24 16:36:36 +0800440/* General purpose, no alignment requirement, iterative (multi-byte) read, */
441/* for area above 1st 4K of SRAM/reg space */
James Ketrenos43f66a62005-03-25 12:31:53 -0600442static void _ipw_read_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
443 int num)
444{
Zhu Yi2638bc32006-01-24 16:37:52 +0800445 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600446 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600447 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400448
James Ketrenos43f66a62005-03-25 12:31:53 -0600449 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
450
James Ketrenosea2b26e2005-08-24 21:25:16 -0500451 if (num <= 0) {
452 return;
453 }
454
Zhu Yic8fe6672006-01-24 16:36:36 +0800455 /* Read the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600456 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500457 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600458 /* Start reading at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500459 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500460 *buf++ = _ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenos43f66a62005-03-25 12:31:53 -0600461 aligned_addr += 4;
462 }
463
Zhu Yic8fe6672006-01-24 16:36:36 +0800464 /* Read all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500465 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500466 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500467 *(u32 *) buf = _ipw_read32(priv, IPW_AUTOINC_DATA);
Jeff Garzikbf794512005-07-31 13:07:26 -0400468
Zhu Yic8fe6672006-01-24 16:36:36 +0800469 /* Read the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500470 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500471 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500472 for (i = 0; num > 0; i++, num--)
James Ketrenosb095c382005-08-24 22:04:42 -0500473 *buf++ = ipw_read8(priv, IPW_INDIRECT_DATA + i);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500474 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600475}
476
Zhu Yic8fe6672006-01-24 16:36:36 +0800477/* General purpose, no alignment requirement, iterative (multi-byte) write, */
478/* for area above 1st 4K of SRAM/reg space */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400479static void _ipw_write_indirect(struct ipw_priv *priv, u32 addr, u8 * buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600480 int num)
481{
Zhu Yi2638bc32006-01-24 16:37:52 +0800482 u32 aligned_addr = addr & IPW_INDIRECT_ADDR_MASK; /* dword align */
James Ketrenos43f66a62005-03-25 12:31:53 -0600483 u32 dif_len = addr - aligned_addr;
James Ketrenos43f66a62005-03-25 12:31:53 -0600484 u32 i;
Jeff Garzikbf794512005-07-31 13:07:26 -0400485
James Ketrenos43f66a62005-03-25 12:31:53 -0600486 IPW_DEBUG_IO("addr = %i, buf = %p, num = %i\n", addr, buf, num);
Jeff Garzikbf794512005-07-31 13:07:26 -0400487
James Ketrenosea2b26e2005-08-24 21:25:16 -0500488 if (num <= 0) {
489 return;
490 }
491
Zhu Yic8fe6672006-01-24 16:36:36 +0800492 /* Write the first dword (or portion) byte by byte */
James Ketrenos43f66a62005-03-25 12:31:53 -0600493 if (unlikely(dif_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500494 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
Zhu Yic8fe6672006-01-24 16:36:36 +0800495 /* Start writing at aligned_addr + dif_len */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500496 for (i = dif_len; ((i < 4) && (num > 0)); i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500497 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenos43f66a62005-03-25 12:31:53 -0600498 aligned_addr += 4;
499 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400500
Zhu Yic8fe6672006-01-24 16:36:36 +0800501 /* Write all of the middle dwords as dwords, with auto-increment */
James Ketrenosb095c382005-08-24 22:04:42 -0500502 _ipw_write32(priv, IPW_AUTOINC_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500503 for (; num >= 4; buf += 4, aligned_addr += 4, num -= 4)
James Ketrenosb095c382005-08-24 22:04:42 -0500504 _ipw_write32(priv, IPW_AUTOINC_DATA, *(u32 *) buf);
Jeff Garzikbf794512005-07-31 13:07:26 -0400505
Zhu Yic8fe6672006-01-24 16:36:36 +0800506 /* Write the last dword (or portion) byte by byte */
James Ketrenosea2b26e2005-08-24 21:25:16 -0500507 if (unlikely(num)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500508 _ipw_write32(priv, IPW_INDIRECT_ADDR, aligned_addr);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500509 for (i = 0; num > 0; i++, num--, buf++)
James Ketrenosb095c382005-08-24 22:04:42 -0500510 _ipw_write8(priv, IPW_INDIRECT_DATA + i, *buf);
James Ketrenosea2b26e2005-08-24 21:25:16 -0500511 }
James Ketrenos43f66a62005-03-25 12:31:53 -0600512}
513
Zhu Yic8fe6672006-01-24 16:36:36 +0800514/* General purpose, no alignment requirement, iterative (multi-byte) write, */
515/* for 1st 4K of SRAM/regs space */
Jeff Garzikbf794512005-07-31 13:07:26 -0400516static void ipw_write_direct(struct ipw_priv *priv, u32 addr, void *buf,
James Ketrenos43f66a62005-03-25 12:31:53 -0600517 int num)
518{
519 memcpy_toio((priv->hw_base + addr), buf, num);
520}
521
Zhu Yic8fe6672006-01-24 16:36:36 +0800522/* Set bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600523static inline void ipw_set_bit(struct ipw_priv *priv, u32 reg, u32 mask)
524{
525 ipw_write32(priv, reg, ipw_read32(priv, reg) | mask);
526}
527
Zhu Yic8fe6672006-01-24 16:36:36 +0800528/* Clear bit(s) in low 4K of SRAM/regs */
James Ketrenos43f66a62005-03-25 12:31:53 -0600529static inline void ipw_clear_bit(struct ipw_priv *priv, u32 reg, u32 mask)
530{
531 ipw_write32(priv, reg, ipw_read32(priv, reg) & ~mask);
532}
533
Zhu Yi89c318e2006-06-08 22:19:49 -0700534static inline void __ipw_enable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600535{
536 if (priv->status & STATUS_INT_ENABLED)
537 return;
538 priv->status |= STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500539 ipw_write32(priv, IPW_INTA_MASK_R, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600540}
541
Zhu Yi89c318e2006-06-08 22:19:49 -0700542static inline void __ipw_disable_interrupts(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -0600543{
544 if (!(priv->status & STATUS_INT_ENABLED))
545 return;
546 priv->status &= ~STATUS_INT_ENABLED;
James Ketrenosb095c382005-08-24 22:04:42 -0500547 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -0600548}
549
Zhu Yi89c318e2006-06-08 22:19:49 -0700550static inline void ipw_enable_interrupts(struct ipw_priv *priv)
551{
552 unsigned long flags;
553
554 spin_lock_irqsave(&priv->irq_lock, flags);
555 __ipw_enable_interrupts(priv);
556 spin_unlock_irqrestore(&priv->irq_lock, flags);
557}
558
559static inline void ipw_disable_interrupts(struct ipw_priv *priv)
560{
561 unsigned long flags;
562
563 spin_lock_irqsave(&priv->irq_lock, flags);
564 __ipw_disable_interrupts(priv);
565 spin_unlock_irqrestore(&priv->irq_lock, flags);
566}
567
James Ketrenos43f66a62005-03-25 12:31:53 -0600568static char *ipw_error_desc(u32 val)
569{
570 switch (val) {
Jeff Garzikbf794512005-07-31 13:07:26 -0400571 case IPW_FW_ERROR_OK:
James Ketrenos43f66a62005-03-25 12:31:53 -0600572 return "ERROR_OK";
Jeff Garzikbf794512005-07-31 13:07:26 -0400573 case IPW_FW_ERROR_FAIL:
James Ketrenos43f66a62005-03-25 12:31:53 -0600574 return "ERROR_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400575 case IPW_FW_ERROR_MEMORY_UNDERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600576 return "MEMORY_UNDERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400577 case IPW_FW_ERROR_MEMORY_OVERFLOW:
James Ketrenos43f66a62005-03-25 12:31:53 -0600578 return "MEMORY_OVERFLOW";
Jeff Garzikbf794512005-07-31 13:07:26 -0400579 case IPW_FW_ERROR_BAD_PARAM:
James Ketrenosb095c382005-08-24 22:04:42 -0500580 return "BAD_PARAM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400581 case IPW_FW_ERROR_BAD_CHECKSUM:
James Ketrenosb095c382005-08-24 22:04:42 -0500582 return "BAD_CHECKSUM";
Jeff Garzikbf794512005-07-31 13:07:26 -0400583 case IPW_FW_ERROR_NMI_INTERRUPT:
James Ketrenosb095c382005-08-24 22:04:42 -0500584 return "NMI_INTERRUPT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400585 case IPW_FW_ERROR_BAD_DATABASE:
James Ketrenosb095c382005-08-24 22:04:42 -0500586 return "BAD_DATABASE";
Jeff Garzikbf794512005-07-31 13:07:26 -0400587 case IPW_FW_ERROR_ALLOC_FAIL:
James Ketrenosb095c382005-08-24 22:04:42 -0500588 return "ALLOC_FAIL";
Jeff Garzikbf794512005-07-31 13:07:26 -0400589 case IPW_FW_ERROR_DMA_UNDERRUN:
James Ketrenosb095c382005-08-24 22:04:42 -0500590 return "DMA_UNDERRUN";
Jeff Garzikbf794512005-07-31 13:07:26 -0400591 case IPW_FW_ERROR_DMA_STATUS:
James Ketrenosb095c382005-08-24 22:04:42 -0500592 return "DMA_STATUS";
593 case IPW_FW_ERROR_DINO_ERROR:
594 return "DINO_ERROR";
595 case IPW_FW_ERROR_EEPROM_ERROR:
596 return "EEPROM_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400597 case IPW_FW_ERROR_SYSASSERT:
James Ketrenosb095c382005-08-24 22:04:42 -0500598 return "SYSASSERT";
Jeff Garzikbf794512005-07-31 13:07:26 -0400599 case IPW_FW_ERROR_FATAL_ERROR:
James Ketrenosb095c382005-08-24 22:04:42 -0500600 return "FATAL_ERROR";
Jeff Garzikbf794512005-07-31 13:07:26 -0400601 default:
James Ketrenosb095c382005-08-24 22:04:42 -0500602 return "UNKNOWN_ERROR";
James Ketrenos43f66a62005-03-25 12:31:53 -0600603 }
604}
605
James Ketrenosb39860c2005-08-12 09:36:32 -0500606static void ipw_dump_error_log(struct ipw_priv *priv,
607 struct ipw_fw_error *error)
James Ketrenos43f66a62005-03-25 12:31:53 -0600608{
James Ketrenosb39860c2005-08-12 09:36:32 -0500609 u32 i;
James Ketrenos43f66a62005-03-25 12:31:53 -0600610
James Ketrenosb39860c2005-08-12 09:36:32 -0500611 if (!error) {
612 IPW_ERROR("Error allocating and capturing error log. "
613 "Nothing to dump.\n");
614 return;
James Ketrenos43f66a62005-03-25 12:31:53 -0600615 }
616
James Ketrenosb39860c2005-08-12 09:36:32 -0500617 IPW_ERROR("Start IPW Error Log Dump:\n");
618 IPW_ERROR("Status: 0x%08X, Config: %08X\n",
619 error->status, error->config);
James Ketrenos43f66a62005-03-25 12:31:53 -0600620
James Ketrenosb39860c2005-08-12 09:36:32 -0500621 for (i = 0; i < error->elem_len; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400622 IPW_ERROR("%s %i 0x%08x 0x%08x 0x%08x 0x%08x 0x%08x\n",
James Ketrenosb39860c2005-08-12 09:36:32 -0500623 ipw_error_desc(error->elem[i].desc),
624 error->elem[i].time,
625 error->elem[i].blink1,
626 error->elem[i].blink2,
627 error->elem[i].link1,
628 error->elem[i].link2, error->elem[i].data);
629 for (i = 0; i < error->log_len; i++)
630 IPW_ERROR("%i\t0x%08x\t%i\n",
631 error->log[i].time,
James Ketrenos286568a2005-08-30 10:34:25 -0500632 error->log[i].data, error->log[i].event);
James Ketrenos43f66a62005-03-25 12:31:53 -0600633}
James Ketrenos43f66a62005-03-25 12:31:53 -0600634
James Ketrenosc848d0a2005-08-24 21:56:24 -0500635static inline int ipw_is_init(struct ipw_priv *priv)
636{
637 return (priv->status & STATUS_INIT) ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -0600638}
639
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400640static int ipw_get_ordinal(struct ipw_priv *priv, u32 ord, void *val, u32 * len)
James Ketrenos43f66a62005-03-25 12:31:53 -0600641{
642 u32 addr, field_info, field_len, field_count, total_len;
643
644 IPW_DEBUG_ORD("ordinal = %i\n", ord);
645
646 if (!priv || !val || !len) {
647 IPW_DEBUG_ORD("Invalid argument\n");
648 return -EINVAL;
649 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400650
James Ketrenos43f66a62005-03-25 12:31:53 -0600651 /* verify device ordinal tables have been initialized */
652 if (!priv->table0_addr || !priv->table1_addr || !priv->table2_addr) {
653 IPW_DEBUG_ORD("Access ordinals before initialization\n");
654 return -EINVAL;
655 }
656
657 switch (IPW_ORD_TABLE_ID_MASK & ord) {
658 case IPW_ORD_TABLE_0_MASK:
659 /*
660 * TABLE 0: Direct access to a table of 32 bit values
661 *
Jeff Garzikbf794512005-07-31 13:07:26 -0400662 * This is a very simple table with the data directly
James Ketrenos43f66a62005-03-25 12:31:53 -0600663 * read from the table
664 */
665
666 /* remove the table id from the ordinal */
667 ord &= IPW_ORD_TABLE_VALUE_MASK;
668
669 /* boundary check */
670 if (ord > priv->table0_len) {
671 IPW_DEBUG_ORD("ordinal value (%i) longer then "
672 "max (%i)\n", ord, priv->table0_len);
673 return -EINVAL;
674 }
675
676 /* verify we have enough room to store the value */
677 if (*len < sizeof(u32)) {
678 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200679 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600680 return -EINVAL;
681 }
682
683 IPW_DEBUG_ORD("Reading TABLE0[%i] from offset 0x%08x\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400684 ord, priv->table0_addr + (ord << 2));
James Ketrenos43f66a62005-03-25 12:31:53 -0600685
686 *len = sizeof(u32);
687 ord <<= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400688 *((u32 *) val) = ipw_read32(priv, priv->table0_addr + ord);
James Ketrenos43f66a62005-03-25 12:31:53 -0600689 break;
690
691 case IPW_ORD_TABLE_1_MASK:
692 /*
693 * TABLE 1: Indirect access to a table of 32 bit values
Jeff Garzikbf794512005-07-31 13:07:26 -0400694 *
695 * This is a fairly large table of u32 values each
James Ketrenos43f66a62005-03-25 12:31:53 -0600696 * representing starting addr for the data (which is
697 * also a u32)
698 */
699
700 /* remove the table id from the ordinal */
701 ord &= IPW_ORD_TABLE_VALUE_MASK;
Jeff Garzikbf794512005-07-31 13:07:26 -0400702
James Ketrenos43f66a62005-03-25 12:31:53 -0600703 /* boundary check */
704 if (ord > priv->table1_len) {
705 IPW_DEBUG_ORD("ordinal value too long\n");
706 return -EINVAL;
707 }
708
709 /* verify we have enough room to store the value */
710 if (*len < sizeof(u32)) {
711 IPW_DEBUG_ORD("ordinal buffer length too small, "
Jiri Bencaaa4d302005-06-07 14:58:41 +0200712 "need %zd\n", sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -0600713 return -EINVAL;
714 }
715
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400716 *((u32 *) val) =
717 ipw_read_reg32(priv, (priv->table1_addr + (ord << 2)));
James Ketrenos43f66a62005-03-25 12:31:53 -0600718 *len = sizeof(u32);
719 break;
720
721 case IPW_ORD_TABLE_2_MASK:
722 /*
723 * TABLE 2: Indirect access to a table of variable sized values
724 *
725 * This table consist of six values, each containing
726 * - dword containing the starting offset of the data
727 * - dword containing the lengh in the first 16bits
728 * and the count in the second 16bits
729 */
730
731 /* remove the table id from the ordinal */
732 ord &= IPW_ORD_TABLE_VALUE_MASK;
733
734 /* boundary check */
735 if (ord > priv->table2_len) {
736 IPW_DEBUG_ORD("ordinal value too long\n");
737 return -EINVAL;
738 }
739
740 /* get the address of statistic */
741 addr = ipw_read_reg32(priv, priv->table2_addr + (ord << 3));
Jeff Garzikbf794512005-07-31 13:07:26 -0400742
743 /* get the second DW of statistics ;
James Ketrenos43f66a62005-03-25 12:31:53 -0600744 * two 16-bit words - first is length, second is count */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400745 field_info =
746 ipw_read_reg32(priv,
747 priv->table2_addr + (ord << 3) +
748 sizeof(u32));
Jeff Garzikbf794512005-07-31 13:07:26 -0400749
James Ketrenos43f66a62005-03-25 12:31:53 -0600750 /* get each entry length */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400751 field_len = *((u16 *) & field_info);
Jeff Garzikbf794512005-07-31 13:07:26 -0400752
James Ketrenos43f66a62005-03-25 12:31:53 -0600753 /* get number of entries */
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400754 field_count = *(((u16 *) & field_info) + 1);
Jeff Garzikbf794512005-07-31 13:07:26 -0400755
James Ketrenos43f66a62005-03-25 12:31:53 -0600756 /* abort if not enought memory */
757 total_len = field_len * field_count;
758 if (total_len > *len) {
759 *len = total_len;
760 return -EINVAL;
761 }
Jeff Garzikbf794512005-07-31 13:07:26 -0400762
James Ketrenos43f66a62005-03-25 12:31:53 -0600763 *len = total_len;
764 if (!total_len)
765 return 0;
766
767 IPW_DEBUG_ORD("addr = 0x%08x, total_len = %i, "
Jeff Garzikbf794512005-07-31 13:07:26 -0400768 "field_info = 0x%08x\n",
James Ketrenos43f66a62005-03-25 12:31:53 -0600769 addr, total_len, field_info);
770 ipw_read_indirect(priv, addr, val, total_len);
771 break;
772
773 default:
774 IPW_DEBUG_ORD("Invalid ordinal!\n");
775 return -EINVAL;
776
777 }
778
James Ketrenos43f66a62005-03-25 12:31:53 -0600779 return 0;
780}
781
782static void ipw_init_ordinals(struct ipw_priv *priv)
783{
784 priv->table0_addr = IPW_ORDINALS_TABLE_LOWER;
Jeff Garzikbf794512005-07-31 13:07:26 -0400785 priv->table0_len = ipw_read32(priv, priv->table0_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -0600786
787 IPW_DEBUG_ORD("table 0 offset at 0x%08x, len = %i\n",
788 priv->table0_addr, priv->table0_len);
789
790 priv->table1_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_1);
791 priv->table1_len = ipw_read_reg32(priv, priv->table1_addr);
792
793 IPW_DEBUG_ORD("table 1 offset at 0x%08x, len = %i\n",
794 priv->table1_addr, priv->table1_len);
795
796 priv->table2_addr = ipw_read32(priv, IPW_ORDINALS_TABLE_2);
797 priv->table2_len = ipw_read_reg32(priv, priv->table2_addr);
Jeff Garzik0edd5b42005-09-07 00:48:31 -0400798 priv->table2_len &= 0x0000ffff; /* use first two bytes */
James Ketrenos43f66a62005-03-25 12:31:53 -0600799
800 IPW_DEBUG_ORD("table 2 offset at 0x%08x, len = %i\n",
801 priv->table2_addr, priv->table2_len);
802
803}
804
Adrian Bunka73e22b2006-01-21 01:39:42 +0100805static u32 ipw_register_toggle(u32 reg)
James Ketrenosa613bff2005-08-24 21:43:11 -0500806{
James Ketrenosb095c382005-08-24 22:04:42 -0500807 reg &= ~IPW_START_STANDBY;
808 if (reg & IPW_GATE_ODMA)
809 reg &= ~IPW_GATE_ODMA;
810 if (reg & IPW_GATE_IDMA)
811 reg &= ~IPW_GATE_IDMA;
812 if (reg & IPW_GATE_ADMA)
813 reg &= ~IPW_GATE_ADMA;
James Ketrenosa613bff2005-08-24 21:43:11 -0500814 return reg;
815}
816
817/*
818 * LED behavior:
819 * - On radio ON, turn on any LEDs that require to be on during start
820 * - On initialization, start unassociated blink
821 * - On association, disable unassociated blink
822 * - On disassociation, start unassociated blink
823 * - On radio OFF, turn off any LEDs started during radio on
824 *
825 */
Zhu Yiede61112006-01-24 16:37:10 +0800826#define LD_TIME_LINK_ON msecs_to_jiffies(300)
827#define LD_TIME_LINK_OFF msecs_to_jiffies(2700)
828#define LD_TIME_ACT_ON msecs_to_jiffies(250)
James Ketrenosa613bff2005-08-24 21:43:11 -0500829
Adrian Bunka73e22b2006-01-21 01:39:42 +0100830static void ipw_led_link_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500831{
832 unsigned long flags;
833 u32 led;
834
835 /* If configured to not use LEDs, or nic_type is 1,
836 * then we don't toggle a LINK led */
837 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
838 return;
839
840 spin_lock_irqsave(&priv->lock, flags);
841
842 if (!(priv->status & STATUS_RF_KILL_MASK) &&
843 !(priv->status & STATUS_LED_LINK_ON)) {
844 IPW_DEBUG_LED("Link LED On\n");
James Ketrenosb095c382005-08-24 22:04:42 -0500845 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500846 led |= priv->led_association_on;
847
848 led = ipw_register_toggle(led);
849
850 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500851 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500852
853 priv->status |= STATUS_LED_LINK_ON;
854
855 /* If we aren't associated, schedule turning the LED off */
856 if (!(priv->status & STATUS_ASSOCIATED))
857 queue_delayed_work(priv->workqueue,
858 &priv->led_link_off,
859 LD_TIME_LINK_ON);
860 }
861
862 spin_unlock_irqrestore(&priv->lock, flags);
863}
864
James Ketrenosc848d0a2005-08-24 21:56:24 -0500865static void ipw_bg_led_link_on(void *data)
866{
867 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800868 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500869 ipw_led_link_on(data);
Zhu Yi46441512006-01-24 16:37:59 +0800870 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500871}
872
Adrian Bunka73e22b2006-01-21 01:39:42 +0100873static void ipw_led_link_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500874{
875 unsigned long flags;
876 u32 led;
877
878 /* If configured not to use LEDs, or nic type is 1,
879 * then we don't goggle the LINK led. */
880 if (priv->config & CFG_NO_LED || priv->nic_type == EEPROM_NIC_TYPE_1)
881 return;
882
883 spin_lock_irqsave(&priv->lock, flags);
884
885 if (priv->status & STATUS_LED_LINK_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500886 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500887 led &= priv->led_association_off;
888 led = ipw_register_toggle(led);
889
890 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500891 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500892
893 IPW_DEBUG_LED("Link LED Off\n");
894
895 priv->status &= ~STATUS_LED_LINK_ON;
896
897 /* If we aren't associated and the radio is on, schedule
898 * turning the LED on (blink while unassociated) */
899 if (!(priv->status & STATUS_RF_KILL_MASK) &&
900 !(priv->status & STATUS_ASSOCIATED))
901 queue_delayed_work(priv->workqueue, &priv->led_link_on,
902 LD_TIME_LINK_OFF);
903
904 }
905
906 spin_unlock_irqrestore(&priv->lock, flags);
907}
908
James Ketrenosc848d0a2005-08-24 21:56:24 -0500909static void ipw_bg_led_link_off(void *data)
910{
911 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800912 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500913 ipw_led_link_off(data);
Zhu Yi46441512006-01-24 16:37:59 +0800914 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500915}
916
Arjan van de Ven858119e2006-01-14 13:20:43 -0800917static void __ipw_led_activity_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500918{
James Ketrenosa613bff2005-08-24 21:43:11 -0500919 u32 led;
920
921 if (priv->config & CFG_NO_LED)
922 return;
923
James Ketrenosb095c382005-08-24 22:04:42 -0500924 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -0500925 return;
James Ketrenosa613bff2005-08-24 21:43:11 -0500926
927 if (!(priv->status & STATUS_LED_ACT_ON)) {
James Ketrenosb095c382005-08-24 22:04:42 -0500928 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500929 led |= priv->led_activity_on;
930
931 led = ipw_register_toggle(led);
932
933 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500934 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500935
936 IPW_DEBUG_LED("Activity LED On\n");
937
938 priv->status |= STATUS_LED_ACT_ON;
939
James Ketrenosc848d0a2005-08-24 21:56:24 -0500940 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -0500941 queue_delayed_work(priv->workqueue, &priv->led_act_off,
942 LD_TIME_ACT_ON);
943 } else {
944 /* Reschedule LED off for full time period */
945 cancel_delayed_work(&priv->led_act_off);
946 queue_delayed_work(priv->workqueue, &priv->led_act_off,
947 LD_TIME_ACT_ON);
948 }
James Ketrenosb095c382005-08-24 22:04:42 -0500949}
James Ketrenosa613bff2005-08-24 21:43:11 -0500950
Adrian Bunka73e22b2006-01-21 01:39:42 +0100951#if 0
James Ketrenosb095c382005-08-24 22:04:42 -0500952void ipw_led_activity_on(struct ipw_priv *priv)
953{
954 unsigned long flags;
955 spin_lock_irqsave(&priv->lock, flags);
956 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -0500957 spin_unlock_irqrestore(&priv->lock, flags);
958}
Adrian Bunka73e22b2006-01-21 01:39:42 +0100959#endif /* 0 */
James Ketrenosa613bff2005-08-24 21:43:11 -0500960
Adrian Bunka73e22b2006-01-21 01:39:42 +0100961static void ipw_led_activity_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500962{
963 unsigned long flags;
964 u32 led;
965
966 if (priv->config & CFG_NO_LED)
967 return;
968
969 spin_lock_irqsave(&priv->lock, flags);
970
971 if (priv->status & STATUS_LED_ACT_ON) {
James Ketrenosb095c382005-08-24 22:04:42 -0500972 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -0500973 led &= priv->led_activity_off;
974
975 led = ipw_register_toggle(led);
976
977 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -0500978 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -0500979
980 IPW_DEBUG_LED("Activity LED Off\n");
981
982 priv->status &= ~STATUS_LED_ACT_ON;
983 }
984
985 spin_unlock_irqrestore(&priv->lock, flags);
986}
987
James Ketrenosc848d0a2005-08-24 21:56:24 -0500988static void ipw_bg_led_activity_off(void *data)
989{
990 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +0800991 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500992 ipw_led_activity_off(data);
Zhu Yi46441512006-01-24 16:37:59 +0800993 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -0500994}
995
Adrian Bunka73e22b2006-01-21 01:39:42 +0100996static void ipw_led_band_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -0500997{
998 unsigned long flags;
999 u32 led;
1000
1001 /* Only nic type 1 supports mode LEDs */
James Ketrenosc848d0a2005-08-24 21:56:24 -05001002 if (priv->config & CFG_NO_LED ||
1003 priv->nic_type != EEPROM_NIC_TYPE_1 || !priv->assoc_network)
James Ketrenosa613bff2005-08-24 21:43:11 -05001004 return;
1005
1006 spin_lock_irqsave(&priv->lock, flags);
1007
James Ketrenosb095c382005-08-24 22:04:42 -05001008 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001009 if (priv->assoc_network->mode == IEEE_A) {
1010 led |= priv->led_ofdm_on;
1011 led &= priv->led_association_off;
1012 IPW_DEBUG_LED("Mode LED On: 802.11a\n");
1013 } else if (priv->assoc_network->mode == IEEE_G) {
1014 led |= priv->led_ofdm_on;
1015 led |= priv->led_association_on;
1016 IPW_DEBUG_LED("Mode LED On: 802.11g\n");
1017 } else {
1018 led &= priv->led_ofdm_off;
1019 led |= priv->led_association_on;
1020 IPW_DEBUG_LED("Mode LED On: 802.11b\n");
1021 }
1022
1023 led = ipw_register_toggle(led);
1024
1025 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001026 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001027
1028 spin_unlock_irqrestore(&priv->lock, flags);
1029}
1030
Adrian Bunka73e22b2006-01-21 01:39:42 +01001031static void ipw_led_band_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001032{
1033 unsigned long flags;
1034 u32 led;
1035
1036 /* Only nic type 1 supports mode LEDs */
1037 if (priv->config & CFG_NO_LED || priv->nic_type != EEPROM_NIC_TYPE_1)
1038 return;
1039
1040 spin_lock_irqsave(&priv->lock, flags);
1041
James Ketrenosb095c382005-08-24 22:04:42 -05001042 led = ipw_read_reg32(priv, IPW_EVENT_REG);
James Ketrenosa613bff2005-08-24 21:43:11 -05001043 led &= priv->led_ofdm_off;
1044 led &= priv->led_association_off;
1045
1046 led = ipw_register_toggle(led);
1047
1048 IPW_DEBUG_LED("Reg: 0x%08X\n", led);
James Ketrenosb095c382005-08-24 22:04:42 -05001049 ipw_write_reg32(priv, IPW_EVENT_REG, led);
James Ketrenosa613bff2005-08-24 21:43:11 -05001050
1051 spin_unlock_irqrestore(&priv->lock, flags);
1052}
1053
Adrian Bunka73e22b2006-01-21 01:39:42 +01001054static void ipw_led_radio_on(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001055{
1056 ipw_led_link_on(priv);
1057}
1058
Adrian Bunka73e22b2006-01-21 01:39:42 +01001059static void ipw_led_radio_off(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001060{
1061 ipw_led_activity_off(priv);
1062 ipw_led_link_off(priv);
1063}
1064
Adrian Bunka73e22b2006-01-21 01:39:42 +01001065static void ipw_led_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001066{
1067 /* Set the Link Led on for all nic types */
1068 ipw_led_link_on(priv);
1069}
1070
Adrian Bunka73e22b2006-01-21 01:39:42 +01001071static void ipw_led_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001072{
1073 ipw_led_activity_off(priv);
1074 ipw_led_link_off(priv);
1075
1076 if (priv->status & STATUS_RF_KILL_MASK)
1077 ipw_led_radio_off(priv);
1078}
1079
Adrian Bunka73e22b2006-01-21 01:39:42 +01001080static void ipw_led_init(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001081{
1082 priv->nic_type = priv->eeprom[EEPROM_NIC_TYPE];
1083
1084 /* Set the default PINs for the link and activity leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001085 priv->led_activity_on = IPW_ACTIVITY_LED;
1086 priv->led_activity_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001087
James Ketrenosb095c382005-08-24 22:04:42 -05001088 priv->led_association_on = IPW_ASSOCIATED_LED;
1089 priv->led_association_off = ~(IPW_ASSOCIATED_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001090
1091 /* Set the default PINs for the OFDM leds */
James Ketrenosb095c382005-08-24 22:04:42 -05001092 priv->led_ofdm_on = IPW_OFDM_LED;
1093 priv->led_ofdm_off = ~(IPW_OFDM_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001094
1095 switch (priv->nic_type) {
1096 case EEPROM_NIC_TYPE_1:
1097 /* In this NIC type, the LEDs are reversed.... */
James Ketrenosb095c382005-08-24 22:04:42 -05001098 priv->led_activity_on = IPW_ASSOCIATED_LED;
1099 priv->led_activity_off = ~(IPW_ASSOCIATED_LED);
1100 priv->led_association_on = IPW_ACTIVITY_LED;
1101 priv->led_association_off = ~(IPW_ACTIVITY_LED);
James Ketrenosa613bff2005-08-24 21:43:11 -05001102
1103 if (!(priv->config & CFG_NO_LED))
1104 ipw_led_band_on(priv);
1105
1106 /* And we don't blink link LEDs for this nic, so
1107 * just return here */
1108 return;
1109
1110 case EEPROM_NIC_TYPE_3:
1111 case EEPROM_NIC_TYPE_2:
1112 case EEPROM_NIC_TYPE_4:
1113 case EEPROM_NIC_TYPE_0:
1114 break;
1115
1116 default:
1117 IPW_DEBUG_INFO("Unknown NIC type from EEPROM: %d\n",
1118 priv->nic_type);
1119 priv->nic_type = EEPROM_NIC_TYPE_0;
1120 break;
1121 }
1122
1123 if (!(priv->config & CFG_NO_LED)) {
1124 if (priv->status & STATUS_ASSOCIATED)
1125 ipw_led_link_on(priv);
1126 else
1127 ipw_led_link_off(priv);
1128 }
1129}
1130
Adrian Bunka73e22b2006-01-21 01:39:42 +01001131static void ipw_led_shutdown(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -05001132{
James Ketrenosa613bff2005-08-24 21:43:11 -05001133 ipw_led_activity_off(priv);
1134 ipw_led_link_off(priv);
1135 ipw_led_band_off(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05001136 cancel_delayed_work(&priv->led_link_on);
1137 cancel_delayed_work(&priv->led_link_off);
1138 cancel_delayed_work(&priv->led_act_off);
James Ketrenosa613bff2005-08-24 21:43:11 -05001139}
1140
James Ketrenos43f66a62005-03-25 12:31:53 -06001141/*
1142 * The following adds a new attribute to the sysfs representation
1143 * of this device driver (i.e. a new file in /sys/bus/pci/drivers/ipw/)
1144 * used for controling the debug level.
Jeff Garzikbf794512005-07-31 13:07:26 -04001145 *
James Ketrenos43f66a62005-03-25 12:31:53 -06001146 * See the level definitions in ipw for details.
1147 */
1148static ssize_t show_debug_level(struct device_driver *d, char *buf)
1149{
1150 return sprintf(buf, "0x%08X\n", ipw_debug_level);
1151}
James Ketrenosa613bff2005-08-24 21:43:11 -05001152
1153static ssize_t store_debug_level(struct device_driver *d, const char *buf,
1154 size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001155{
1156 char *p = (char *)buf;
1157 u32 val;
1158
1159 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1160 p++;
1161 if (p[0] == 'x' || p[0] == 'X')
1162 p++;
1163 val = simple_strtoul(p, &p, 16);
1164 } else
1165 val = simple_strtoul(p, &p, 10);
Jeff Garzikbf794512005-07-31 13:07:26 -04001166 if (p == buf)
1167 printk(KERN_INFO DRV_NAME
James Ketrenos43f66a62005-03-25 12:31:53 -06001168 ": %s is not in hex or decimal form.\n", buf);
1169 else
1170 ipw_debug_level = val;
1171
1172 return strnlen(buf, count);
1173}
1174
Jeff Garzikbf794512005-07-31 13:07:26 -04001175static DRIVER_ATTR(debug_level, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001176 show_debug_level, store_debug_level);
1177
James Ketrenosb39860c2005-08-12 09:36:32 -05001178static inline u32 ipw_get_event_log_len(struct ipw_priv *priv)
1179{
Zhu Yic8fe6672006-01-24 16:36:36 +08001180 /* length = 1st dword in log */
James Ketrenosb39860c2005-08-12 09:36:32 -05001181 return ipw_read_reg32(priv, ipw_read32(priv, IPW_EVENT_LOG));
1182}
1183
1184static void ipw_capture_event_log(struct ipw_priv *priv,
1185 u32 log_len, struct ipw_event *log)
1186{
1187 u32 base;
1188
1189 if (log_len) {
1190 base = ipw_read32(priv, IPW_EVENT_LOG);
1191 ipw_read_indirect(priv, base + sizeof(base) + sizeof(u32),
1192 (u8 *) log, sizeof(*log) * log_len);
1193 }
1194}
1195
1196static struct ipw_fw_error *ipw_alloc_error_log(struct ipw_priv *priv)
1197{
1198 struct ipw_fw_error *error;
1199 u32 log_len = ipw_get_event_log_len(priv);
1200 u32 base = ipw_read32(priv, IPW_ERROR_LOG);
1201 u32 elem_len = ipw_read_reg32(priv, base);
1202
1203 error = kmalloc(sizeof(*error) +
1204 sizeof(*error->elem) * elem_len +
1205 sizeof(*error->log) * log_len, GFP_ATOMIC);
1206 if (!error) {
1207 IPW_ERROR("Memory allocation for firmware error log "
1208 "failed.\n");
1209 return NULL;
1210 }
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001211 error->jiffies = jiffies;
James Ketrenosb39860c2005-08-12 09:36:32 -05001212 error->status = priv->status;
1213 error->config = priv->config;
1214 error->elem_len = elem_len;
1215 error->log_len = log_len;
1216 error->elem = (struct ipw_error_elem *)error->payload;
Zhu Yi3b26b112005-11-17 13:58:30 +08001217 error->log = (struct ipw_event *)(error->elem + elem_len);
James Ketrenosb39860c2005-08-12 09:36:32 -05001218
1219 ipw_capture_event_log(priv, log_len, error->log);
1220
1221 if (elem_len)
1222 ipw_read_indirect(priv, base + sizeof(base), (u8 *) error->elem,
1223 sizeof(*error->elem) * elem_len);
1224
1225 return error;
1226}
1227
James Ketrenosb39860c2005-08-12 09:36:32 -05001228static ssize_t show_event_log(struct device *d,
1229 struct device_attribute *attr, char *buf)
1230{
1231 struct ipw_priv *priv = dev_get_drvdata(d);
1232 u32 log_len = ipw_get_event_log_len(priv);
1233 struct ipw_event log[log_len];
1234 u32 len = 0, i;
1235
1236 ipw_capture_event_log(priv, log_len, log);
1237
1238 len += snprintf(buf + len, PAGE_SIZE - len, "%08X", log_len);
1239 for (i = 0; i < log_len; i++)
1240 len += snprintf(buf + len, PAGE_SIZE - len,
1241 "\n%08X%08X%08X",
1242 log[i].time, log[i].event, log[i].data);
1243 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1244 return len;
1245}
1246
1247static DEVICE_ATTR(event_log, S_IRUGO, show_event_log, NULL);
1248
1249static ssize_t show_error(struct device *d,
1250 struct device_attribute *attr, char *buf)
1251{
1252 struct ipw_priv *priv = dev_get_drvdata(d);
1253 u32 len = 0, i;
1254 if (!priv->error)
1255 return 0;
1256 len += snprintf(buf + len, PAGE_SIZE - len,
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001257 "%08lX%08X%08X%08X",
1258 priv->error->jiffies,
James Ketrenosb39860c2005-08-12 09:36:32 -05001259 priv->error->status,
1260 priv->error->config, priv->error->elem_len);
1261 for (i = 0; i < priv->error->elem_len; i++)
1262 len += snprintf(buf + len, PAGE_SIZE - len,
1263 "\n%08X%08X%08X%08X%08X%08X%08X",
1264 priv->error->elem[i].time,
1265 priv->error->elem[i].desc,
1266 priv->error->elem[i].blink1,
1267 priv->error->elem[i].blink2,
1268 priv->error->elem[i].link1,
1269 priv->error->elem[i].link2,
1270 priv->error->elem[i].data);
1271
1272 len += snprintf(buf + len, PAGE_SIZE - len,
1273 "\n%08X", priv->error->log_len);
1274 for (i = 0; i < priv->error->log_len; i++)
1275 len += snprintf(buf + len, PAGE_SIZE - len,
1276 "\n%08X%08X%08X",
1277 priv->error->log[i].time,
1278 priv->error->log[i].event,
1279 priv->error->log[i].data);
1280 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1281 return len;
1282}
1283
1284static ssize_t clear_error(struct device *d,
1285 struct device_attribute *attr,
1286 const char *buf, size_t count)
1287{
1288 struct ipw_priv *priv = dev_get_drvdata(d);
Jesper Juhl8f760782006-06-27 02:55:06 -07001289
1290 kfree(priv->error);
1291 priv->error = NULL;
James Ketrenosb39860c2005-08-12 09:36:32 -05001292 return count;
1293}
1294
1295static DEVICE_ATTR(error, S_IRUGO | S_IWUSR, show_error, clear_error);
1296
James Ketrenosf6c5cb72005-08-25 00:39:09 -05001297static ssize_t show_cmd_log(struct device *d,
1298 struct device_attribute *attr, char *buf)
1299{
1300 struct ipw_priv *priv = dev_get_drvdata(d);
1301 u32 len = 0, i;
1302 if (!priv->cmdlog)
1303 return 0;
1304 for (i = (priv->cmdlog_pos + 1) % priv->cmdlog_len;
1305 (i != priv->cmdlog_pos) && (PAGE_SIZE - len);
1306 i = (i + 1) % priv->cmdlog_len) {
1307 len +=
1308 snprintf(buf + len, PAGE_SIZE - len,
1309 "\n%08lX%08X%08X%08X\n", priv->cmdlog[i].jiffies,
1310 priv->cmdlog[i].retcode, priv->cmdlog[i].cmd.cmd,
1311 priv->cmdlog[i].cmd.len);
1312 len +=
1313 snprintk_buf(buf + len, PAGE_SIZE - len,
1314 (u8 *) priv->cmdlog[i].cmd.param,
1315 priv->cmdlog[i].cmd.len);
1316 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1317 }
1318 len += snprintf(buf + len, PAGE_SIZE - len, "\n");
1319 return len;
1320}
1321
1322static DEVICE_ATTR(cmd_log, S_IRUGO, show_cmd_log, NULL);
1323
Zhu Yid685b8c2006-04-13 17:20:27 +08001324#ifdef CONFIG_IPW2200_PROMISCUOUS
1325static void ipw_prom_free(struct ipw_priv *priv);
1326static int ipw_prom_alloc(struct ipw_priv *priv);
1327static ssize_t store_rtap_iface(struct device *d,
1328 struct device_attribute *attr,
1329 const char *buf, size_t count)
1330{
1331 struct ipw_priv *priv = dev_get_drvdata(d);
1332 int rc = 0;
1333
1334 if (count < 1)
1335 return -EINVAL;
1336
1337 switch (buf[0]) {
1338 case '0':
1339 if (!rtap_iface)
1340 return count;
1341
1342 if (netif_running(priv->prom_net_dev)) {
1343 IPW_WARNING("Interface is up. Cannot unregister.\n");
1344 return count;
1345 }
1346
1347 ipw_prom_free(priv);
1348 rtap_iface = 0;
1349 break;
1350
1351 case '1':
1352 if (rtap_iface)
1353 return count;
1354
1355 rc = ipw_prom_alloc(priv);
1356 if (!rc)
1357 rtap_iface = 1;
1358 break;
1359
1360 default:
1361 return -EINVAL;
1362 }
1363
1364 if (rc) {
1365 IPW_ERROR("Failed to register promiscuous network "
1366 "device (error %d).\n", rc);
1367 }
1368
1369 return count;
1370}
1371
1372static ssize_t show_rtap_iface(struct device *d,
1373 struct device_attribute *attr,
1374 char *buf)
1375{
1376 struct ipw_priv *priv = dev_get_drvdata(d);
1377 if (rtap_iface)
1378 return sprintf(buf, "%s", priv->prom_net_dev->name);
1379 else {
1380 buf[0] = '-';
1381 buf[1] = '1';
1382 buf[2] = '\0';
1383 return 3;
1384 }
1385}
1386
1387static DEVICE_ATTR(rtap_iface, S_IWUSR | S_IRUSR, show_rtap_iface,
1388 store_rtap_iface);
1389
1390static ssize_t store_rtap_filter(struct device *d,
1391 struct device_attribute *attr,
1392 const char *buf, size_t count)
1393{
1394 struct ipw_priv *priv = dev_get_drvdata(d);
1395
1396 if (!priv->prom_priv) {
1397 IPW_ERROR("Attempting to set filter without "
1398 "rtap_iface enabled.\n");
1399 return -EPERM;
1400 }
1401
1402 priv->prom_priv->filter = simple_strtol(buf, NULL, 0);
1403
1404 IPW_DEBUG_INFO("Setting rtap filter to " BIT_FMT16 "\n",
1405 BIT_ARG16(priv->prom_priv->filter));
1406
1407 return count;
1408}
1409
1410static ssize_t show_rtap_filter(struct device *d,
1411 struct device_attribute *attr,
1412 char *buf)
1413{
1414 struct ipw_priv *priv = dev_get_drvdata(d);
1415 return sprintf(buf, "0x%04X",
1416 priv->prom_priv ? priv->prom_priv->filter : 0);
1417}
1418
1419static DEVICE_ATTR(rtap_filter, S_IWUSR | S_IRUSR, show_rtap_filter,
1420 store_rtap_filter);
1421#endif
1422
James Ketrenosa613bff2005-08-24 21:43:11 -05001423static ssize_t show_scan_age(struct device *d, struct device_attribute *attr,
1424 char *buf)
1425{
1426 struct ipw_priv *priv = dev_get_drvdata(d);
1427 return sprintf(buf, "%d\n", priv->ieee->scan_age);
1428}
1429
1430static ssize_t store_scan_age(struct device *d, struct device_attribute *attr,
1431 const char *buf, size_t count)
1432{
1433 struct ipw_priv *priv = dev_get_drvdata(d);
1434 struct net_device *dev = priv->net_dev;
1435 char buffer[] = "00000000";
1436 unsigned long len =
1437 (sizeof(buffer) - 1) > count ? count : sizeof(buffer) - 1;
1438 unsigned long val;
1439 char *p = buffer;
1440
1441 IPW_DEBUG_INFO("enter\n");
1442
1443 strncpy(buffer, buf, len);
1444 buffer[len] = 0;
1445
1446 if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') {
1447 p++;
1448 if (p[0] == 'x' || p[0] == 'X')
1449 p++;
1450 val = simple_strtoul(p, &p, 16);
1451 } else
1452 val = simple_strtoul(p, &p, 10);
1453 if (p == buffer) {
1454 IPW_DEBUG_INFO("%s: user supplied invalid value.\n", dev->name);
1455 } else {
1456 priv->ieee->scan_age = val;
1457 IPW_DEBUG_INFO("set scan_age = %u\n", priv->ieee->scan_age);
1458 }
1459
1460 IPW_DEBUG_INFO("exit\n");
1461 return len;
1462}
1463
1464static DEVICE_ATTR(scan_age, S_IWUSR | S_IRUGO, show_scan_age, store_scan_age);
1465
1466static ssize_t show_led(struct device *d, struct device_attribute *attr,
1467 char *buf)
1468{
1469 struct ipw_priv *priv = dev_get_drvdata(d);
1470 return sprintf(buf, "%d\n", (priv->config & CFG_NO_LED) ? 0 : 1);
1471}
1472
1473static ssize_t store_led(struct device *d, struct device_attribute *attr,
1474 const char *buf, size_t count)
1475{
1476 struct ipw_priv *priv = dev_get_drvdata(d);
1477
1478 IPW_DEBUG_INFO("enter\n");
1479
1480 if (count == 0)
1481 return 0;
1482
1483 if (*buf == 0) {
1484 IPW_DEBUG_LED("Disabling LED control.\n");
1485 priv->config |= CFG_NO_LED;
1486 ipw_led_shutdown(priv);
1487 } else {
1488 IPW_DEBUG_LED("Enabling LED control.\n");
1489 priv->config &= ~CFG_NO_LED;
1490 ipw_led_init(priv);
1491 }
1492
1493 IPW_DEBUG_INFO("exit\n");
1494 return count;
1495}
1496
1497static DEVICE_ATTR(led, S_IWUSR | S_IRUGO, show_led, store_led);
1498
Andrew Mortonad3fee52005-06-20 14:30:36 -07001499static ssize_t show_status(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001500 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001501{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001502 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001503 return sprintf(buf, "0x%08x\n", (int)p->status);
1504}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001505
James Ketrenos43f66a62005-03-25 12:31:53 -06001506static DEVICE_ATTR(status, S_IRUGO, show_status, NULL);
1507
Andrew Mortonad3fee52005-06-20 14:30:36 -07001508static ssize_t show_cfg(struct device *d, struct device_attribute *attr,
1509 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001510{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001511 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001512 return sprintf(buf, "0x%08x\n", (int)p->config);
1513}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001514
James Ketrenos43f66a62005-03-25 12:31:53 -06001515static DEVICE_ATTR(cfg, S_IRUGO, show_cfg, NULL);
1516
Andrew Mortonad3fee52005-06-20 14:30:36 -07001517static ssize_t show_nic_type(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001518 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001519{
James Ketrenosa613bff2005-08-24 21:43:11 -05001520 struct ipw_priv *priv = d->driver_data;
1521 return sprintf(buf, "TYPE: %d\n", priv->nic_type);
James Ketrenos43f66a62005-03-25 12:31:53 -06001522}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001523
James Ketrenos43f66a62005-03-25 12:31:53 -06001524static DEVICE_ATTR(nic_type, S_IRUGO, show_nic_type, NULL);
1525
Andrew Mortonad3fee52005-06-20 14:30:36 -07001526static ssize_t show_ucode_version(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001527 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001528{
1529 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001530 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001531
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001532 if (ipw_get_ordinal(p, IPW_ORD_STAT_UCODE_VERSION, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001533 return 0;
1534
1535 return sprintf(buf, "0x%08x\n", tmp);
1536}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001537
1538static DEVICE_ATTR(ucode_version, S_IWUSR | S_IRUGO, show_ucode_version, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001539
Andrew Mortonad3fee52005-06-20 14:30:36 -07001540static ssize_t show_rtc(struct device *d, struct device_attribute *attr,
1541 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001542{
1543 u32 len = sizeof(u32), tmp = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001544 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001545
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001546 if (ipw_get_ordinal(p, IPW_ORD_STAT_RTC, &tmp, &len))
James Ketrenos43f66a62005-03-25 12:31:53 -06001547 return 0;
1548
1549 return sprintf(buf, "0x%08x\n", tmp);
1550}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001551
1552static DEVICE_ATTR(rtc, S_IWUSR | S_IRUGO, show_rtc, NULL);
James Ketrenos43f66a62005-03-25 12:31:53 -06001553
1554/*
1555 * Add a device attribute to view/control the delay between eeprom
1556 * operations.
1557 */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001558static ssize_t show_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001559 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001560{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001561 int n = ((struct ipw_priv *)d->driver_data)->eeprom_delay;
James Ketrenos43f66a62005-03-25 12:31:53 -06001562 return sprintf(buf, "%i\n", n);
1563}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001564static ssize_t store_eeprom_delay(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001565 struct device_attribute *attr,
1566 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001567{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001568 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001569 sscanf(buf, "%i", &p->eeprom_delay);
1570 return strnlen(buf, count);
1571}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001572
1573static DEVICE_ATTR(eeprom_delay, S_IWUSR | S_IRUGO,
1574 show_eeprom_delay, store_eeprom_delay);
James Ketrenos43f66a62005-03-25 12:31:53 -06001575
Andrew Mortonad3fee52005-06-20 14:30:36 -07001576static ssize_t show_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001577 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001578{
1579 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001580 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001581
James Ketrenosb095c382005-08-24 22:04:42 -05001582 reg = ipw_read_reg32(p, IPW_INTERNAL_CMD_EVENT);
James Ketrenos43f66a62005-03-25 12:31:53 -06001583 return sprintf(buf, "0x%08x\n", reg);
1584}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001585static ssize_t store_command_event_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001586 struct device_attribute *attr,
1587 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001588{
1589 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001590 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001591
1592 sscanf(buf, "%x", &reg);
James Ketrenosb095c382005-08-24 22:04:42 -05001593 ipw_write_reg32(p, IPW_INTERNAL_CMD_EVENT, reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001594 return strnlen(buf, count);
1595}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001596
1597static DEVICE_ATTR(command_event_reg, S_IWUSR | S_IRUGO,
1598 show_command_event_reg, store_command_event_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001599
Andrew Mortonad3fee52005-06-20 14:30:36 -07001600static ssize_t show_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001601 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001602{
1603 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001604 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001605
1606 reg = ipw_read_reg32(p, 0x301100);
1607 return sprintf(buf, "0x%08x\n", reg);
1608}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001609static ssize_t store_mem_gpio_reg(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001610 struct device_attribute *attr,
1611 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001612{
1613 u32 reg;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001614 struct ipw_priv *p = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001615
1616 sscanf(buf, "%x", &reg);
1617 ipw_write_reg32(p, 0x301100, reg);
1618 return strnlen(buf, count);
1619}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001620
1621static DEVICE_ATTR(mem_gpio_reg, S_IWUSR | S_IRUGO,
1622 show_mem_gpio_reg, store_mem_gpio_reg);
James Ketrenos43f66a62005-03-25 12:31:53 -06001623
Andrew Mortonad3fee52005-06-20 14:30:36 -07001624static ssize_t show_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001625 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001626{
1627 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001628 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001629
Jeff Garzikbf794512005-07-31 13:07:26 -04001630 if (priv->status & STATUS_INDIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001631 reg = ipw_read_reg32(priv, priv->indirect_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001632 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001633 reg = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04001634
James Ketrenos43f66a62005-03-25 12:31:53 -06001635 return sprintf(buf, "0x%08x\n", reg);
1636}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001637static ssize_t store_indirect_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001638 struct device_attribute *attr,
1639 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001640{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001641 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001642
1643 sscanf(buf, "%x", &priv->indirect_dword);
1644 priv->status |= STATUS_INDIRECT_DWORD;
1645 return strnlen(buf, count);
1646}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001647
1648static DEVICE_ATTR(indirect_dword, S_IWUSR | S_IRUGO,
1649 show_indirect_dword, store_indirect_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001650
Andrew Mortonad3fee52005-06-20 14:30:36 -07001651static ssize_t show_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001652 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001653{
1654 u8 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001655 struct ipw_priv *priv = d->driver_data;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001656
Jeff Garzikbf794512005-07-31 13:07:26 -04001657 if (priv->status & STATUS_INDIRECT_BYTE)
James Ketrenos43f66a62005-03-25 12:31:53 -06001658 reg = ipw_read_reg8(priv, priv->indirect_byte);
Jeff Garzikbf794512005-07-31 13:07:26 -04001659 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001660 reg = 0;
1661
1662 return sprintf(buf, "0x%02x\n", reg);
1663}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001664static ssize_t store_indirect_byte(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001665 struct device_attribute *attr,
1666 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001667{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001668 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001669
1670 sscanf(buf, "%x", &priv->indirect_byte);
1671 priv->status |= STATUS_INDIRECT_BYTE;
1672 return strnlen(buf, count);
1673}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001674
1675static DEVICE_ATTR(indirect_byte, S_IWUSR | S_IRUGO,
James Ketrenos43f66a62005-03-25 12:31:53 -06001676 show_indirect_byte, store_indirect_byte);
1677
Andrew Mortonad3fee52005-06-20 14:30:36 -07001678static ssize_t show_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001679 struct device_attribute *attr, char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001680{
1681 u32 reg = 0;
Andrew Mortonad3fee52005-06-20 14:30:36 -07001682 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001683
Jeff Garzikbf794512005-07-31 13:07:26 -04001684 if (priv->status & STATUS_DIRECT_DWORD)
James Ketrenos43f66a62005-03-25 12:31:53 -06001685 reg = ipw_read32(priv, priv->direct_dword);
Jeff Garzikbf794512005-07-31 13:07:26 -04001686 else
James Ketrenos43f66a62005-03-25 12:31:53 -06001687 reg = 0;
1688
1689 return sprintf(buf, "0x%08x\n", reg);
1690}
Andrew Mortonad3fee52005-06-20 14:30:36 -07001691static ssize_t store_direct_dword(struct device *d,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001692 struct device_attribute *attr,
1693 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001694{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001695 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001696
1697 sscanf(buf, "%x", &priv->direct_dword);
1698 priv->status |= STATUS_DIRECT_DWORD;
1699 return strnlen(buf, count);
1700}
James Ketrenos43f66a62005-03-25 12:31:53 -06001701
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001702static DEVICE_ATTR(direct_dword, S_IWUSR | S_IRUGO,
1703 show_direct_dword, store_direct_dword);
James Ketrenos43f66a62005-03-25 12:31:53 -06001704
Arjan van de Ven858119e2006-01-14 13:20:43 -08001705static int rf_kill_active(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06001706{
1707 if (0 == (ipw_read32(priv, 0x30) & 0x10000))
1708 priv->status |= STATUS_RF_KILL_HW;
1709 else
1710 priv->status &= ~STATUS_RF_KILL_HW;
1711
1712 return (priv->status & STATUS_RF_KILL_HW) ? 1 : 0;
1713}
1714
Andrew Mortonad3fee52005-06-20 14:30:36 -07001715static ssize_t show_rf_kill(struct device *d, struct device_attribute *attr,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001716 char *buf)
James Ketrenos43f66a62005-03-25 12:31:53 -06001717{
1718 /* 0 - RF kill not enabled
Jeff Garzikbf794512005-07-31 13:07:26 -04001719 1 - SW based RF kill active (sysfs)
James Ketrenos43f66a62005-03-25 12:31:53 -06001720 2 - HW based RF kill active
1721 3 - Both HW and SW baed RF kill active */
Andrew Mortonad3fee52005-06-20 14:30:36 -07001722 struct ipw_priv *priv = d->driver_data;
James Ketrenos43f66a62005-03-25 12:31:53 -06001723 int val = ((priv->status & STATUS_RF_KILL_SW) ? 0x1 : 0x0) |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001724 (rf_kill_active(priv) ? 0x2 : 0x0);
James Ketrenos43f66a62005-03-25 12:31:53 -06001725 return sprintf(buf, "%i\n", val);
1726}
1727
1728static int ipw_radio_kill_sw(struct ipw_priv *priv, int disable_radio)
1729{
Jeff Garzikbf794512005-07-31 13:07:26 -04001730 if ((disable_radio ? 1 : 0) ==
James Ketrenosea2b26e2005-08-24 21:25:16 -05001731 ((priv->status & STATUS_RF_KILL_SW) ? 1 : 0))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001732 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06001733
1734 IPW_DEBUG_RF_KILL("Manual SW RF Kill set to: RADIO %s\n",
1735 disable_radio ? "OFF" : "ON");
1736
1737 if (disable_radio) {
1738 priv->status |= STATUS_RF_KILL_SW;
1739
James Ketrenosa613bff2005-08-24 21:43:11 -05001740 if (priv->workqueue)
James Ketrenos43f66a62005-03-25 12:31:53 -06001741 cancel_delayed_work(&priv->request_scan);
James Ketrenos43f66a62005-03-25 12:31:53 -06001742 queue_work(priv->workqueue, &priv->down);
1743 } else {
1744 priv->status &= ~STATUS_RF_KILL_SW;
1745 if (rf_kill_active(priv)) {
1746 IPW_DEBUG_RF_KILL("Can not turn radio back on - "
1747 "disabled by HW switch\n");
1748 /* Make sure the RF_KILL check timer is running */
1749 cancel_delayed_work(&priv->rf_kill);
Jeff Garzikbf794512005-07-31 13:07:26 -04001750 queue_delayed_work(priv->workqueue, &priv->rf_kill,
James Ketrenos43f66a62005-03-25 12:31:53 -06001751 2 * HZ);
Jeff Garzikbf794512005-07-31 13:07:26 -04001752 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06001753 queue_work(priv->workqueue, &priv->up);
1754 }
1755
1756 return 1;
1757}
1758
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001759static ssize_t store_rf_kill(struct device *d, struct device_attribute *attr,
1760 const char *buf, size_t count)
James Ketrenos43f66a62005-03-25 12:31:53 -06001761{
Andrew Mortonad3fee52005-06-20 14:30:36 -07001762 struct ipw_priv *priv = d->driver_data;
Jeff Garzikbf794512005-07-31 13:07:26 -04001763
James Ketrenos43f66a62005-03-25 12:31:53 -06001764 ipw_radio_kill_sw(priv, buf[0] == '1');
1765
1766 return count;
1767}
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001768
1769static DEVICE_ATTR(rf_kill, S_IWUSR | S_IRUGO, show_rf_kill, store_rf_kill);
James Ketrenos43f66a62005-03-25 12:31:53 -06001770
James Ketrenosb095c382005-08-24 22:04:42 -05001771static ssize_t show_speed_scan(struct device *d, struct device_attribute *attr,
1772 char *buf)
1773{
1774 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1775 int pos = 0, len = 0;
1776 if (priv->config & CFG_SPEED_SCAN) {
1777 while (priv->speed_scan[pos] != 0)
1778 len += sprintf(&buf[len], "%d ",
1779 priv->speed_scan[pos++]);
1780 return len + sprintf(&buf[len], "\n");
1781 }
1782
1783 return sprintf(buf, "0\n");
1784}
1785
1786static ssize_t store_speed_scan(struct device *d, struct device_attribute *attr,
1787 const char *buf, size_t count)
1788{
1789 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1790 int channel, pos = 0;
1791 const char *p = buf;
1792
1793 /* list of space separated channels to scan, optionally ending with 0 */
1794 while ((channel = simple_strtol(p, NULL, 0))) {
1795 if (pos == MAX_SPEED_SCAN - 1) {
1796 priv->speed_scan[pos] = 0;
1797 break;
1798 }
1799
Larry Finger1867b112006-02-28 09:48:28 -06001800 if (ieee80211_is_valid_channel(priv->ieee, channel))
James Ketrenosb095c382005-08-24 22:04:42 -05001801 priv->speed_scan[pos++] = channel;
1802 else
1803 IPW_WARNING("Skipping invalid channel request: %d\n",
1804 channel);
1805 p = strchr(p, ' ');
1806 if (!p)
1807 break;
1808 while (*p == ' ' || *p == '\t')
1809 p++;
1810 }
1811
1812 if (pos == 0)
1813 priv->config &= ~CFG_SPEED_SCAN;
1814 else {
1815 priv->speed_scan_pos = 0;
1816 priv->config |= CFG_SPEED_SCAN;
1817 }
1818
1819 return count;
1820}
1821
1822static DEVICE_ATTR(speed_scan, S_IWUSR | S_IRUGO, show_speed_scan,
1823 store_speed_scan);
1824
1825static ssize_t show_net_stats(struct device *d, struct device_attribute *attr,
1826 char *buf)
1827{
1828 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1829 return sprintf(buf, "%c\n", (priv->config & CFG_NET_STATS) ? '1' : '0');
1830}
1831
1832static ssize_t store_net_stats(struct device *d, struct device_attribute *attr,
1833 const char *buf, size_t count)
1834{
1835 struct ipw_priv *priv = (struct ipw_priv *)d->driver_data;
1836 if (buf[0] == '1')
1837 priv->config |= CFG_NET_STATS;
1838 else
1839 priv->config &= ~CFG_NET_STATS;
1840
1841 return count;
1842}
1843
James Ketrenosafbf30a2005-08-25 00:05:33 -05001844static DEVICE_ATTR(net_stats, S_IWUSR | S_IRUGO,
1845 show_net_stats, store_net_stats);
James Ketrenosb095c382005-08-24 22:04:42 -05001846
James Ketrenosea2b26e2005-08-24 21:25:16 -05001847static void notify_wx_assoc_event(struct ipw_priv *priv)
1848{
1849 union iwreq_data wrqu;
1850 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
1851 if (priv->status & STATUS_ASSOCIATED)
1852 memcpy(wrqu.ap_addr.sa_data, priv->bssid, ETH_ALEN);
1853 else
1854 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
1855 wireless_send_event(priv->net_dev, SIOCGIWAP, &wrqu, NULL);
1856}
1857
James Ketrenos43f66a62005-03-25 12:31:53 -06001858static void ipw_irq_tasklet(struct ipw_priv *priv)
1859{
1860 u32 inta, inta_mask, handled = 0;
1861 unsigned long flags;
1862 int rc = 0;
1863
Zhu Yi89c318e2006-06-08 22:19:49 -07001864 spin_lock_irqsave(&priv->irq_lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06001865
James Ketrenosb095c382005-08-24 22:04:42 -05001866 inta = ipw_read32(priv, IPW_INTA_RW);
1867 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
1868 inta &= (IPW_INTA_MASK_ALL & inta_mask);
James Ketrenos43f66a62005-03-25 12:31:53 -06001869
1870 /* Add any cached INTA values that need to be handled */
1871 inta |= priv->isr_inta;
1872
Zhu Yi89c318e2006-06-08 22:19:49 -07001873 spin_unlock_irqrestore(&priv->irq_lock, flags);
1874
1875 spin_lock_irqsave(&priv->lock, flags);
1876
James Ketrenos43f66a62005-03-25 12:31:53 -06001877 /* handle all the justifications for the interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05001878 if (inta & IPW_INTA_BIT_RX_TRANSFER) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001879 ipw_rx(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05001880 handled |= IPW_INTA_BIT_RX_TRANSFER;
James Ketrenos43f66a62005-03-25 12:31:53 -06001881 }
1882
James Ketrenosb095c382005-08-24 22:04:42 -05001883 if (inta & IPW_INTA_BIT_TX_CMD_QUEUE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001884 IPW_DEBUG_HC("Command completed.\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001885 rc = ipw_queue_tx_reclaim(priv, &priv->txq_cmd, -1);
James Ketrenos43f66a62005-03-25 12:31:53 -06001886 priv->status &= ~STATUS_HCMD_ACTIVE;
1887 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosb095c382005-08-24 22:04:42 -05001888 handled |= IPW_INTA_BIT_TX_CMD_QUEUE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001889 }
1890
James Ketrenosb095c382005-08-24 22:04:42 -05001891 if (inta & IPW_INTA_BIT_TX_QUEUE_1) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001892 IPW_DEBUG_TX("TX_QUEUE_1\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001893 rc = ipw_queue_tx_reclaim(priv, &priv->txq[0], 0);
James Ketrenosb095c382005-08-24 22:04:42 -05001894 handled |= IPW_INTA_BIT_TX_QUEUE_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06001895 }
1896
James Ketrenosb095c382005-08-24 22:04:42 -05001897 if (inta & IPW_INTA_BIT_TX_QUEUE_2) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001898 IPW_DEBUG_TX("TX_QUEUE_2\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001899 rc = ipw_queue_tx_reclaim(priv, &priv->txq[1], 1);
James Ketrenosb095c382005-08-24 22:04:42 -05001900 handled |= IPW_INTA_BIT_TX_QUEUE_2;
James Ketrenos43f66a62005-03-25 12:31:53 -06001901 }
1902
James Ketrenosb095c382005-08-24 22:04:42 -05001903 if (inta & IPW_INTA_BIT_TX_QUEUE_3) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001904 IPW_DEBUG_TX("TX_QUEUE_3\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001905 rc = ipw_queue_tx_reclaim(priv, &priv->txq[2], 2);
James Ketrenosb095c382005-08-24 22:04:42 -05001906 handled |= IPW_INTA_BIT_TX_QUEUE_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06001907 }
1908
James Ketrenosb095c382005-08-24 22:04:42 -05001909 if (inta & IPW_INTA_BIT_TX_QUEUE_4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001910 IPW_DEBUG_TX("TX_QUEUE_4\n");
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001911 rc = ipw_queue_tx_reclaim(priv, &priv->txq[3], 3);
James Ketrenosb095c382005-08-24 22:04:42 -05001912 handled |= IPW_INTA_BIT_TX_QUEUE_4;
James Ketrenos43f66a62005-03-25 12:31:53 -06001913 }
1914
James Ketrenosb095c382005-08-24 22:04:42 -05001915 if (inta & IPW_INTA_BIT_STATUS_CHANGE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001916 IPW_WARNING("STATUS_CHANGE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001917 handled |= IPW_INTA_BIT_STATUS_CHANGE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001918 }
1919
James Ketrenosb095c382005-08-24 22:04:42 -05001920 if (inta & IPW_INTA_BIT_BEACON_PERIOD_EXPIRED) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001921 IPW_WARNING("TX_PERIOD_EXPIRED\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001922 handled |= IPW_INTA_BIT_BEACON_PERIOD_EXPIRED;
James Ketrenos43f66a62005-03-25 12:31:53 -06001923 }
1924
James Ketrenosb095c382005-08-24 22:04:42 -05001925 if (inta & IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001926 IPW_WARNING("HOST_CMD_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001927 handled |= IPW_INTA_BIT_SLAVE_MODE_HOST_CMD_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001928 }
1929
James Ketrenosb095c382005-08-24 22:04:42 -05001930 if (inta & IPW_INTA_BIT_FW_INITIALIZATION_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001931 IPW_WARNING("FW_INITIALIZATION_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001932 handled |= IPW_INTA_BIT_FW_INITIALIZATION_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001933 }
1934
James Ketrenosb095c382005-08-24 22:04:42 -05001935 if (inta & IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001936 IPW_WARNING("PHY_OFF_DONE\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001937 handled |= IPW_INTA_BIT_FW_CARD_DISABLE_PHY_OFF_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001938 }
1939
James Ketrenosb095c382005-08-24 22:04:42 -05001940 if (inta & IPW_INTA_BIT_RF_KILL_DONE) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001941 IPW_DEBUG_RF_KILL("RF_KILL_DONE\n");
1942 priv->status |= STATUS_RF_KILL_HW;
1943 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosea2b26e2005-08-24 21:25:16 -05001944 priv->status &= ~(STATUS_ASSOCIATED | STATUS_ASSOCIATING);
James Ketrenos43f66a62005-03-25 12:31:53 -06001945 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05001946 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06001947 queue_delayed_work(priv->workqueue, &priv->rf_kill, 2 * HZ);
James Ketrenosb095c382005-08-24 22:04:42 -05001948 handled |= IPW_INTA_BIT_RF_KILL_DONE;
James Ketrenos43f66a62005-03-25 12:31:53 -06001949 }
Jeff Garzikbf794512005-07-31 13:07:26 -04001950
James Ketrenosb095c382005-08-24 22:04:42 -05001951 if (inta & IPW_INTA_BIT_FATAL_ERROR) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001952 IPW_WARNING("Firmware error detected. Restarting.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001953 if (priv->error) {
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001954 IPW_DEBUG_FW("Sysfs 'error' log already exists.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001955 if (ipw_debug_level & IPW_DL_FW_ERRORS) {
1956 struct ipw_fw_error *error =
1957 ipw_alloc_error_log(priv);
1958 ipw_dump_error_log(priv, error);
Jesper Juhl8f760782006-06-27 02:55:06 -07001959 kfree(error);
James Ketrenosb39860c2005-08-12 09:36:32 -05001960 }
James Ketrenosb39860c2005-08-12 09:36:32 -05001961 } else {
1962 priv->error = ipw_alloc_error_log(priv);
1963 if (priv->error)
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001964 IPW_DEBUG_FW("Sysfs 'error' log captured.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001965 else
Zhu Yi1d1b09e2006-03-02 06:40:59 +08001966 IPW_DEBUG_FW("Error allocating sysfs 'error' "
1967 "log.\n");
James Ketrenosb39860c2005-08-12 09:36:32 -05001968 if (ipw_debug_level & IPW_DL_FW_ERRORS)
1969 ipw_dump_error_log(priv, priv->error);
James Ketrenosb39860c2005-08-12 09:36:32 -05001970 }
1971
James Ketrenosb095c382005-08-24 22:04:42 -05001972 /* XXX: If hardware encryption is for WPA/WPA2,
1973 * we have to notify the supplicant. */
1974 if (priv->ieee->sec.encrypt) {
1975 priv->status &= ~STATUS_ASSOCIATED;
1976 notify_wx_assoc_event(priv);
1977 }
1978
1979 /* Keep the restart process from trying to send host
1980 * commands by clearing the INIT status bit */
1981 priv->status &= ~STATUS_INIT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05001982
1983 /* Cancel currently queued command. */
1984 priv->status &= ~STATUS_HCMD_ACTIVE;
1985 wake_up_interruptible(&priv->wait_command_queue);
1986
James Ketrenos43f66a62005-03-25 12:31:53 -06001987 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenosb095c382005-08-24 22:04:42 -05001988 handled |= IPW_INTA_BIT_FATAL_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06001989 }
1990
James Ketrenosb095c382005-08-24 22:04:42 -05001991 if (inta & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06001992 IPW_ERROR("Parity error\n");
James Ketrenosb095c382005-08-24 22:04:42 -05001993 handled |= IPW_INTA_BIT_PARITY_ERROR;
James Ketrenos43f66a62005-03-25 12:31:53 -06001994 }
1995
1996 if (handled != inta) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04001997 IPW_ERROR("Unhandled INTA bits 0x%08x\n", inta & ~handled);
James Ketrenos43f66a62005-03-25 12:31:53 -06001998 }
1999
Zhu Yi89c318e2006-06-08 22:19:49 -07002000 spin_unlock_irqrestore(&priv->lock, flags);
2001
James Ketrenos43f66a62005-03-25 12:31:53 -06002002 /* enable all interrupts */
2003 ipw_enable_interrupts(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06002004}
Jeff Garzikbf794512005-07-31 13:07:26 -04002005
James Ketrenos43f66a62005-03-25 12:31:53 -06002006#define IPW_CMD(x) case IPW_CMD_ ## x : return #x
2007static char *get_cmd_string(u8 cmd)
2008{
2009 switch (cmd) {
2010 IPW_CMD(HOST_COMPLETE);
Jeff Garzikbf794512005-07-31 13:07:26 -04002011 IPW_CMD(POWER_DOWN);
2012 IPW_CMD(SYSTEM_CONFIG);
2013 IPW_CMD(MULTICAST_ADDRESS);
2014 IPW_CMD(SSID);
2015 IPW_CMD(ADAPTER_ADDRESS);
2016 IPW_CMD(PORT_TYPE);
2017 IPW_CMD(RTS_THRESHOLD);
2018 IPW_CMD(FRAG_THRESHOLD);
2019 IPW_CMD(POWER_MODE);
2020 IPW_CMD(WEP_KEY);
2021 IPW_CMD(TGI_TX_KEY);
2022 IPW_CMD(SCAN_REQUEST);
2023 IPW_CMD(SCAN_REQUEST_EXT);
2024 IPW_CMD(ASSOCIATE);
2025 IPW_CMD(SUPPORTED_RATES);
2026 IPW_CMD(SCAN_ABORT);
2027 IPW_CMD(TX_FLUSH);
2028 IPW_CMD(QOS_PARAMETERS);
2029 IPW_CMD(DINO_CONFIG);
2030 IPW_CMD(RSN_CAPABILITIES);
2031 IPW_CMD(RX_KEY);
2032 IPW_CMD(CARD_DISABLE);
2033 IPW_CMD(SEED_NUMBER);
2034 IPW_CMD(TX_POWER);
2035 IPW_CMD(COUNTRY_INFO);
2036 IPW_CMD(AIRONET_INFO);
2037 IPW_CMD(AP_TX_POWER);
2038 IPW_CMD(CCKM_INFO);
2039 IPW_CMD(CCX_VER_INFO);
2040 IPW_CMD(SET_CALIBRATION);
2041 IPW_CMD(SENSITIVITY_CALIB);
2042 IPW_CMD(RETRY_LIMIT);
2043 IPW_CMD(IPW_PRE_POWER_DOWN);
2044 IPW_CMD(VAP_BEACON_TEMPLATE);
2045 IPW_CMD(VAP_DTIM_PERIOD);
2046 IPW_CMD(EXT_SUPPORTED_RATES);
2047 IPW_CMD(VAP_LOCAL_TX_PWR_CONSTRAINT);
2048 IPW_CMD(VAP_QUIET_INTERVALS);
2049 IPW_CMD(VAP_CHANNEL_SWITCH);
2050 IPW_CMD(VAP_MANDATORY_CHANNELS);
2051 IPW_CMD(VAP_CELL_PWR_LIMIT);
2052 IPW_CMD(VAP_CF_PARAM_SET);
2053 IPW_CMD(VAP_SET_BEACONING_STATE);
2054 IPW_CMD(MEASUREMENT);
2055 IPW_CMD(POWER_CAPABILITY);
2056 IPW_CMD(SUPPORTED_CHANNELS);
2057 IPW_CMD(TPC_REPORT);
2058 IPW_CMD(WME_INFO);
2059 IPW_CMD(PRODUCTION_COMMAND);
2060 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06002061 return "UNKNOWN";
2062 }
2063}
James Ketrenos43f66a62005-03-25 12:31:53 -06002064
2065#define HOST_COMPLETE_TIMEOUT HZ
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002066
2067static int __ipw_send_cmd(struct ipw_priv *priv, struct host_cmd *cmd)
James Ketrenos43f66a62005-03-25 12:31:53 -06002068{
2069 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002070 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06002071
James Ketrenosa613bff2005-08-24 21:43:11 -05002072 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002073 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002074 IPW_ERROR("Failed to send %s: Already sending a command.\n",
2075 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002076 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002077 return -EAGAIN;
James Ketrenos43f66a62005-03-25 12:31:53 -06002078 }
2079
2080 priv->status |= STATUS_HCMD_ACTIVE;
Jeff Garzikbf794512005-07-31 13:07:26 -04002081
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002082 if (priv->cmdlog) {
2083 priv->cmdlog[priv->cmdlog_pos].jiffies = jiffies;
2084 priv->cmdlog[priv->cmdlog_pos].cmd.cmd = cmd->cmd;
2085 priv->cmdlog[priv->cmdlog_pos].cmd.len = cmd->len;
2086 memcpy(priv->cmdlog[priv->cmdlog_pos].cmd.param, cmd->param,
2087 cmd->len);
2088 priv->cmdlog[priv->cmdlog_pos].retcode = -1;
2089 }
2090
James Ketrenosb095c382005-08-24 22:04:42 -05002091 IPW_DEBUG_HC("%s command (#%d) %d bytes: 0x%08X\n",
2092 get_cmd_string(cmd->cmd), cmd->cmd, cmd->len,
2093 priv->status);
Zhu Yif516dbc2006-01-24 16:36:44 +08002094
2095#ifndef DEBUG_CMD_WEP_KEY
2096 if (cmd->cmd == IPW_CMD_WEP_KEY)
2097 IPW_DEBUG_HC("WEP_KEY command masked out for secure.\n");
2098 else
2099#endif
2100 printk_buf(IPW_DL_HOST_COMMAND, (u8 *) cmd->param, cmd->len);
2101
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002102 rc = ipw_queue_tx_hcmd(priv, cmd->cmd, cmd->param, cmd->len, 0);
James Ketrenosa613bff2005-08-24 21:43:11 -05002103 if (rc) {
2104 priv->status &= ~STATUS_HCMD_ACTIVE;
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002105 IPW_ERROR("Failed to send %s: Reason %d\n",
2106 get_cmd_string(cmd->cmd), rc);
James Ketrenosa613bff2005-08-24 21:43:11 -05002107 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002108 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002109 }
2110 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002111
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002112 rc = wait_event_interruptible_timeout(priv->wait_command_queue,
2113 !(priv->
2114 status & STATUS_HCMD_ACTIVE),
2115 HOST_COMPLETE_TIMEOUT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002116 if (rc == 0) {
James Ketrenosa613bff2005-08-24 21:43:11 -05002117 spin_lock_irqsave(&priv->lock, flags);
2118 if (priv->status & STATUS_HCMD_ACTIVE) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002119 IPW_ERROR("Failed to send %s: Command timed out.\n",
2120 get_cmd_string(cmd->cmd));
James Ketrenosa613bff2005-08-24 21:43:11 -05002121 priv->status &= ~STATUS_HCMD_ACTIVE;
2122 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002123 rc = -EIO;
2124 goto exit;
James Ketrenosa613bff2005-08-24 21:43:11 -05002125 }
2126 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos3b9990c2005-08-19 13:18:55 -05002127 } else
2128 rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05002129
James Ketrenosb095c382005-08-24 22:04:42 -05002130 if (priv->status & STATUS_RF_KILL_HW) {
James Ketrenos9ddf84f2005-08-16 17:07:11 -05002131 IPW_ERROR("Failed to send %s: Aborted due to RF kill switch.\n",
2132 get_cmd_string(cmd->cmd));
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002133 rc = -EIO;
2134 goto exit;
James Ketrenos43f66a62005-03-25 12:31:53 -06002135 }
2136
Zhu Yi2638bc32006-01-24 16:37:52 +08002137 exit:
James Ketrenosf6c5cb72005-08-25 00:39:09 -05002138 if (priv->cmdlog) {
2139 priv->cmdlog[priv->cmdlog_pos++].retcode = rc;
2140 priv->cmdlog_pos %= priv->cmdlog_len;
2141 }
2142 return rc;
James Ketrenos43f66a62005-03-25 12:31:53 -06002143}
2144
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002145static int ipw_send_cmd_simple(struct ipw_priv *priv, u8 command)
James Ketrenos43f66a62005-03-25 12:31:53 -06002146{
2147 struct host_cmd cmd = {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002148 .cmd = command,
James Ketrenos43f66a62005-03-25 12:31:53 -06002149 };
2150
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002151 return __ipw_send_cmd(priv, &cmd);
2152}
2153
2154static int ipw_send_cmd_pdu(struct ipw_priv *priv, u8 command, u8 len,
2155 void *data)
2156{
2157 struct host_cmd cmd = {
2158 .cmd = command,
2159 .len = len,
2160 .param = data,
2161 };
2162
2163 return __ipw_send_cmd(priv, &cmd);
2164}
2165
2166static int ipw_send_host_complete(struct ipw_priv *priv)
2167{
James Ketrenos43f66a62005-03-25 12:31:53 -06002168 if (!priv) {
2169 IPW_ERROR("Invalid args\n");
2170 return -1;
2171 }
2172
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002173 return ipw_send_cmd_simple(priv, IPW_CMD_HOST_COMPLETE);
James Ketrenos43f66a62005-03-25 12:31:53 -06002174}
2175
Zhu Yid685b8c2006-04-13 17:20:27 +08002176static int ipw_send_system_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002177{
Zhu Yid685b8c2006-04-13 17:20:27 +08002178 return ipw_send_cmd_pdu(priv, IPW_CMD_SYSTEM_CONFIG,
2179 sizeof(priv->sys_config),
2180 &priv->sys_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06002181}
2182
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002183static int ipw_send_ssid(struct ipw_priv *priv, u8 * ssid, int len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002184{
James Ketrenos43f66a62005-03-25 12:31:53 -06002185 if (!priv || !ssid) {
2186 IPW_ERROR("Invalid args\n");
2187 return -1;
2188 }
2189
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002190 return ipw_send_cmd_pdu(priv, IPW_CMD_SSID, min(len, IW_ESSID_MAX_SIZE),
Zhu Yi2638bc32006-01-24 16:37:52 +08002191 ssid);
James Ketrenos43f66a62005-03-25 12:31:53 -06002192}
2193
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002194static int ipw_send_adapter_address(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002195{
James Ketrenos43f66a62005-03-25 12:31:53 -06002196 if (!priv || !mac) {
2197 IPW_ERROR("Invalid args\n");
2198 return -1;
2199 }
2200
2201 IPW_DEBUG_INFO("%s: Setting MAC to " MAC_FMT "\n",
2202 priv->net_dev->name, MAC_ARG(mac));
2203
Zhu Yi2638bc32006-01-24 16:37:52 +08002204 return ipw_send_cmd_pdu(priv, IPW_CMD_ADAPTER_ADDRESS, ETH_ALEN, mac);
James Ketrenos43f66a62005-03-25 12:31:53 -06002205}
2206
James Ketrenosa613bff2005-08-24 21:43:11 -05002207/*
2208 * NOTE: This must be executed from our workqueue as it results in udelay
2209 * being called which may corrupt the keyboard if executed on default
2210 * workqueue
2211 */
James Ketrenos43f66a62005-03-25 12:31:53 -06002212static void ipw_adapter_restart(void *adapter)
2213{
2214 struct ipw_priv *priv = adapter;
2215
2216 if (priv->status & STATUS_RF_KILL_MASK)
2217 return;
2218
2219 ipw_down(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05002220
2221 if (priv->assoc_network &&
2222 (priv->assoc_network->capability & WLAN_CAPABILITY_IBSS))
2223 ipw_remove_current_network(priv);
2224
James Ketrenos43f66a62005-03-25 12:31:53 -06002225 if (ipw_up(priv)) {
2226 IPW_ERROR("Failed to up device\n");
2227 return;
2228 }
2229}
2230
James Ketrenosc848d0a2005-08-24 21:56:24 -05002231static void ipw_bg_adapter_restart(void *data)
2232{
2233 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08002234 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002235 ipw_adapter_restart(data);
Zhu Yi46441512006-01-24 16:37:59 +08002236 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002237}
2238
James Ketrenos43f66a62005-03-25 12:31:53 -06002239#define IPW_SCAN_CHECK_WATCHDOG (5 * HZ)
2240
2241static void ipw_scan_check(void *data)
2242{
2243 struct ipw_priv *priv = data;
2244 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
2245 IPW_DEBUG_SCAN("Scan completion watchdog resetting "
Zhu Yic7b6a672006-01-24 16:37:05 +08002246 "adapter after (%dms).\n",
2247 jiffies_to_msecs(IPW_SCAN_CHECK_WATCHDOG));
James Ketrenosa613bff2005-08-24 21:43:11 -05002248 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06002249 }
2250}
2251
James Ketrenosc848d0a2005-08-24 21:56:24 -05002252static void ipw_bg_scan_check(void *data)
2253{
2254 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08002255 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002256 ipw_scan_check(data);
Zhu Yi46441512006-01-24 16:37:59 +08002257 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05002258}
2259
James Ketrenos43f66a62005-03-25 12:31:53 -06002260static int ipw_send_scan_request_ext(struct ipw_priv *priv,
2261 struct ipw_scan_request_ext *request)
2262{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002263 return ipw_send_cmd_pdu(priv, IPW_CMD_SCAN_REQUEST_EXT,
Zhu Yi2638bc32006-01-24 16:37:52 +08002264 sizeof(*request), request);
James Ketrenos43f66a62005-03-25 12:31:53 -06002265}
2266
2267static int ipw_send_scan_abort(struct ipw_priv *priv)
2268{
James Ketrenos43f66a62005-03-25 12:31:53 -06002269 if (!priv) {
2270 IPW_ERROR("Invalid args\n");
2271 return -1;
2272 }
2273
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002274 return ipw_send_cmd_simple(priv, IPW_CMD_SCAN_ABORT);
James Ketrenos43f66a62005-03-25 12:31:53 -06002275}
2276
2277static int ipw_set_sensitivity(struct ipw_priv *priv, u16 sens)
2278{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002279 struct ipw_sensitivity_calib calib = {
Zhu Yi851ca262006-08-21 11:37:58 +08002280 .beacon_rssi_raw = cpu_to_le16(sens),
James Ketrenos43f66a62005-03-25 12:31:53 -06002281 };
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002282
2283 return ipw_send_cmd_pdu(priv, IPW_CMD_SENSITIVITY_CALIB, sizeof(calib),
Zhu Yi2638bc32006-01-24 16:37:52 +08002284 &calib);
James Ketrenos43f66a62005-03-25 12:31:53 -06002285}
2286
2287static int ipw_send_associate(struct ipw_priv *priv,
2288 struct ipw_associate *associate)
2289{
James Ketrenosa613bff2005-08-24 21:43:11 -05002290 struct ipw_associate tmp_associate;
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002291
2292 if (!priv || !associate) {
2293 IPW_ERROR("Invalid args\n");
2294 return -1;
2295 }
2296
James Ketrenosa613bff2005-08-24 21:43:11 -05002297 memcpy(&tmp_associate, associate, sizeof(*associate));
2298 tmp_associate.policy_support =
2299 cpu_to_le16(tmp_associate.policy_support);
2300 tmp_associate.assoc_tsf_msw = cpu_to_le32(tmp_associate.assoc_tsf_msw);
2301 tmp_associate.assoc_tsf_lsw = cpu_to_le32(tmp_associate.assoc_tsf_lsw);
2302 tmp_associate.capability = cpu_to_le16(tmp_associate.capability);
2303 tmp_associate.listen_interval =
2304 cpu_to_le16(tmp_associate.listen_interval);
2305 tmp_associate.beacon_interval =
2306 cpu_to_le16(tmp_associate.beacon_interval);
2307 tmp_associate.atim_window = cpu_to_le16(tmp_associate.atim_window);
2308
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002309 return ipw_send_cmd_pdu(priv, IPW_CMD_ASSOCIATE, sizeof(tmp_associate),
Zhu Yi2638bc32006-01-24 16:37:52 +08002310 &tmp_associate);
James Ketrenos43f66a62005-03-25 12:31:53 -06002311}
2312
2313static int ipw_send_supported_rates(struct ipw_priv *priv,
2314 struct ipw_supported_rates *rates)
2315{
James Ketrenos43f66a62005-03-25 12:31:53 -06002316 if (!priv || !rates) {
2317 IPW_ERROR("Invalid args\n");
2318 return -1;
2319 }
2320
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002321 return ipw_send_cmd_pdu(priv, IPW_CMD_SUPPORTED_RATES, sizeof(*rates),
Zhu Yi2638bc32006-01-24 16:37:52 +08002322 rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06002323}
2324
2325static int ipw_set_random_seed(struct ipw_priv *priv)
2326{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002327 u32 val;
James Ketrenos43f66a62005-03-25 12:31:53 -06002328
2329 if (!priv) {
2330 IPW_ERROR("Invalid args\n");
2331 return -1;
2332 }
2333
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002334 get_random_bytes(&val, sizeof(val));
James Ketrenos43f66a62005-03-25 12:31:53 -06002335
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002336 return ipw_send_cmd_pdu(priv, IPW_CMD_SEED_NUMBER, sizeof(val), &val);
James Ketrenos43f66a62005-03-25 12:31:53 -06002337}
2338
James Ketrenos43f66a62005-03-25 12:31:53 -06002339static int ipw_send_card_disable(struct ipw_priv *priv, u32 phy_off)
2340{
James Ketrenos43f66a62005-03-25 12:31:53 -06002341 if (!priv) {
2342 IPW_ERROR("Invalid args\n");
2343 return -1;
2344 }
2345
Zhu Yi851ca262006-08-21 11:37:58 +08002346 phy_off = cpu_to_le32(phy_off);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002347 return ipw_send_cmd_pdu(priv, IPW_CMD_CARD_DISABLE, sizeof(phy_off),
Zhu Yi2638bc32006-01-24 16:37:52 +08002348 &phy_off);
James Ketrenos43f66a62005-03-25 12:31:53 -06002349}
James Ketrenos43f66a62005-03-25 12:31:53 -06002350
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002351static int ipw_send_tx_power(struct ipw_priv *priv, struct ipw_tx_power *power)
James Ketrenos43f66a62005-03-25 12:31:53 -06002352{
James Ketrenos43f66a62005-03-25 12:31:53 -06002353 if (!priv || !power) {
2354 IPW_ERROR("Invalid args\n");
2355 return -1;
2356 }
2357
Zhu Yi2638bc32006-01-24 16:37:52 +08002358 return ipw_send_cmd_pdu(priv, IPW_CMD_TX_POWER, sizeof(*power), power);
James Ketrenos43f66a62005-03-25 12:31:53 -06002359}
James Ketrenos43f66a62005-03-25 12:31:53 -06002360
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002361static int ipw_set_tx_power(struct ipw_priv *priv)
2362{
Larry Finger1867b112006-02-28 09:48:28 -06002363 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08002364 struct ipw_tx_power tx_power;
2365 s8 max_power;
2366 int i;
2367
2368 memset(&tx_power, 0, sizeof(tx_power));
2369
2370 /* configure device for 'G' band */
2371 tx_power.ieee_mode = IPW_G_MODE;
2372 tx_power.num_channels = geo->bg_channels;
2373 for (i = 0; i < geo->bg_channels; i++) {
2374 max_power = geo->bg[i].max_power;
2375 tx_power.channels_tx_power[i].channel_number =
2376 geo->bg[i].channel;
2377 tx_power.channels_tx_power[i].tx_power = max_power ?
2378 min(max_power, priv->tx_power) : priv->tx_power;
2379 }
2380 if (ipw_send_tx_power(priv, &tx_power))
2381 return -EIO;
2382
2383 /* configure device to also handle 'B' band */
2384 tx_power.ieee_mode = IPW_B_MODE;
2385 if (ipw_send_tx_power(priv, &tx_power))
2386 return -EIO;
2387
2388 /* configure device to also handle 'A' band */
2389 if (priv->ieee->abg_true) {
2390 tx_power.ieee_mode = IPW_A_MODE;
2391 tx_power.num_channels = geo->a_channels;
2392 for (i = 0; i < tx_power.num_channels; i++) {
2393 max_power = geo->a[i].max_power;
2394 tx_power.channels_tx_power[i].channel_number =
2395 geo->a[i].channel;
2396 tx_power.channels_tx_power[i].tx_power = max_power ?
2397 min(max_power, priv->tx_power) : priv->tx_power;
2398 }
2399 if (ipw_send_tx_power(priv, &tx_power))
2400 return -EIO;
2401 }
James Ketrenos43f66a62005-03-25 12:31:53 -06002402 return 0;
2403}
2404
2405static int ipw_send_rts_threshold(struct ipw_priv *priv, u16 rts)
2406{
2407 struct ipw_rts_threshold rts_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002408 .rts_threshold = cpu_to_le16(rts),
James Ketrenos43f66a62005-03-25 12:31:53 -06002409 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002410
2411 if (!priv) {
2412 IPW_ERROR("Invalid args\n");
2413 return -1;
2414 }
2415
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002416 return ipw_send_cmd_pdu(priv, IPW_CMD_RTS_THRESHOLD,
2417 sizeof(rts_threshold), &rts_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002418}
2419
2420static int ipw_send_frag_threshold(struct ipw_priv *priv, u16 frag)
2421{
2422 struct ipw_frag_threshold frag_threshold = {
Zhu Yi851ca262006-08-21 11:37:58 +08002423 .frag_threshold = cpu_to_le16(frag),
James Ketrenos43f66a62005-03-25 12:31:53 -06002424 };
James Ketrenos43f66a62005-03-25 12:31:53 -06002425
2426 if (!priv) {
2427 IPW_ERROR("Invalid args\n");
2428 return -1;
2429 }
2430
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002431 return ipw_send_cmd_pdu(priv, IPW_CMD_FRAG_THRESHOLD,
2432 sizeof(frag_threshold), &frag_threshold);
James Ketrenos43f66a62005-03-25 12:31:53 -06002433}
2434
2435static int ipw_send_power_mode(struct ipw_priv *priv, u32 mode)
2436{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002437 u32 param;
James Ketrenos43f66a62005-03-25 12:31:53 -06002438
2439 if (!priv) {
2440 IPW_ERROR("Invalid args\n");
2441 return -1;
2442 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002443
James Ketrenos43f66a62005-03-25 12:31:53 -06002444 /* If on battery, set to 3, if AC set to CAM, else user
2445 * level */
2446 switch (mode) {
2447 case IPW_POWER_BATTERY:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002448 param = IPW_POWER_INDEX_3;
James Ketrenos43f66a62005-03-25 12:31:53 -06002449 break;
2450 case IPW_POWER_AC:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002451 param = IPW_POWER_MODE_CAM;
James Ketrenos43f66a62005-03-25 12:31:53 -06002452 break;
2453 default:
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002454 param = mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06002455 break;
2456 }
2457
Zhu Yi851ca262006-08-21 11:37:58 +08002458 param = cpu_to_le32(mode);
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002459 return ipw_send_cmd_pdu(priv, IPW_CMD_POWER_MODE, sizeof(param),
Zhu Yi2638bc32006-01-24 16:37:52 +08002460 &param);
James Ketrenos43f66a62005-03-25 12:31:53 -06002461}
2462
James Ketrenosafbf30a2005-08-25 00:05:33 -05002463static int ipw_send_retry_limit(struct ipw_priv *priv, u8 slimit, u8 llimit)
2464{
2465 struct ipw_retry_limit retry_limit = {
2466 .short_retry_limit = slimit,
2467 .long_retry_limit = llimit
2468 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05002469
2470 if (!priv) {
2471 IPW_ERROR("Invalid args\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002472 return -1;
2473 }
2474
Zhu Yi0a7bcf22006-01-24 16:37:28 +08002475 return ipw_send_cmd_pdu(priv, IPW_CMD_RETRY_LIMIT, sizeof(retry_limit),
Zhu Yi2638bc32006-01-24 16:37:52 +08002476 &retry_limit);
James Ketrenos43f66a62005-03-25 12:31:53 -06002477}
2478
2479/*
2480 * The IPW device contains a Microwire compatible EEPROM that stores
2481 * various data like the MAC address. Usually the firmware has exclusive
2482 * access to the eeprom, but during device initialization (before the
2483 * device driver has sent the HostComplete command to the firmware) the
2484 * device driver has read access to the EEPROM by way of indirect addressing
2485 * through a couple of memory mapped registers.
2486 *
2487 * The following is a simplified implementation for pulling data out of the
2488 * the eeprom, along with some helper functions to find information in
2489 * the per device private data's copy of the eeprom.
2490 *
2491 * NOTE: To better understand how these functions work (i.e what is a chip
2492 * select and why do have to keep driving the eeprom clock?), read
2493 * just about any data sheet for a Microwire compatible EEPROM.
2494 */
2495
2496/* write a 32 bit value into the indirect accessor register */
2497static inline void eeprom_write_reg(struct ipw_priv *p, u32 data)
2498{
2499 ipw_write_reg32(p, FW_MEM_REG_EEPROM_ACCESS, data);
Jeff Garzikbf794512005-07-31 13:07:26 -04002500
James Ketrenos43f66a62005-03-25 12:31:53 -06002501 /* the eeprom requires some time to complete the operation */
2502 udelay(p->eeprom_delay);
2503
2504 return;
2505}
2506
2507/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002508static void eeprom_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002509{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002510 eeprom_write_reg(priv, 0);
2511 eeprom_write_reg(priv, EEPROM_BIT_CS);
2512 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2513 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002514}
2515
2516/* perform a chip select operation */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002517static void eeprom_disable_cs(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002518{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002519 eeprom_write_reg(priv, EEPROM_BIT_CS);
2520 eeprom_write_reg(priv, 0);
2521 eeprom_write_reg(priv, EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002522}
2523
2524/* push a single bit down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002525static inline void eeprom_write_bit(struct ipw_priv *p, u8 bit)
James Ketrenos43f66a62005-03-25 12:31:53 -06002526{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002527 int d = (bit ? EEPROM_BIT_DI : 0);
2528 eeprom_write_reg(p, EEPROM_BIT_CS | d);
2529 eeprom_write_reg(p, EEPROM_BIT_CS | d | EEPROM_BIT_SK);
James Ketrenos43f66a62005-03-25 12:31:53 -06002530}
2531
2532/* push an opcode followed by an address down to the eeprom */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002533static void eeprom_op(struct ipw_priv *priv, u8 op, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002534{
2535 int i;
2536
2537 eeprom_cs(priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002538 eeprom_write_bit(priv, 1);
2539 eeprom_write_bit(priv, op & 2);
2540 eeprom_write_bit(priv, op & 1);
2541 for (i = 7; i >= 0; i--) {
2542 eeprom_write_bit(priv, addr & (1 << i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002543 }
2544}
2545
2546/* pull 16 bits off the eeprom, one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002547static u16 eeprom_read_u16(struct ipw_priv *priv, u8 addr)
James Ketrenos43f66a62005-03-25 12:31:53 -06002548{
2549 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002550 u16 r = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002551
James Ketrenos43f66a62005-03-25 12:31:53 -06002552 /* Send READ Opcode */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002553 eeprom_op(priv, EEPROM_CMD_READ, addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06002554
2555 /* Send dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002556 eeprom_write_reg(priv, EEPROM_BIT_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06002557
2558 /* Read the byte off the eeprom one bit at a time */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002559 for (i = 0; i < 16; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002560 u32 data = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002561 eeprom_write_reg(priv, EEPROM_BIT_CS | EEPROM_BIT_SK);
2562 eeprom_write_reg(priv, EEPROM_BIT_CS);
2563 data = ipw_read_reg32(priv, FW_MEM_REG_EEPROM_ACCESS);
2564 r = (r << 1) | ((data & EEPROM_BIT_DO) ? 1 : 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002565 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002566
James Ketrenos43f66a62005-03-25 12:31:53 -06002567 /* Send another dummy bit */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002568 eeprom_write_reg(priv, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002569 eeprom_disable_cs(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002570
James Ketrenos43f66a62005-03-25 12:31:53 -06002571 return r;
2572}
2573
2574/* helper function for pulling the mac address out of the private */
2575/* data's copy of the eeprom data */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002576static void eeprom_parse_mac(struct ipw_priv *priv, u8 * mac)
James Ketrenos43f66a62005-03-25 12:31:53 -06002577{
James Ketrenosafbf30a2005-08-25 00:05:33 -05002578 memcpy(mac, &priv->eeprom[EEPROM_MAC_ADDRESS], 6);
James Ketrenos43f66a62005-03-25 12:31:53 -06002579}
2580
2581/*
2582 * Either the device driver (i.e. the host) or the firmware can
2583 * load eeprom data into the designated region in SRAM. If neither
2584 * happens then the FW will shutdown with a fatal error.
2585 *
2586 * In order to signal the FW to load the EEPROM, the EEPROM_LOAD_DISABLE
2587 * bit needs region of shared SRAM needs to be non-zero.
2588 */
2589static void ipw_eeprom_init_sram(struct ipw_priv *priv)
2590{
2591 int i;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002592 u16 *eeprom = (u16 *) priv->eeprom;
Jeff Garzikbf794512005-07-31 13:07:26 -04002593
James Ketrenos43f66a62005-03-25 12:31:53 -06002594 IPW_DEBUG_TRACE(">>\n");
2595
2596 /* read entire contents of eeprom into private buffer */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002597 for (i = 0; i < 128; i++)
James Ketrenosa613bff2005-08-24 21:43:11 -05002598 eeprom[i] = le16_to_cpu(eeprom_read_u16(priv, (u8) i));
James Ketrenos43f66a62005-03-25 12:31:53 -06002599
Jeff Garzikbf794512005-07-31 13:07:26 -04002600 /*
2601 If the data looks correct, then copy it to our private
James Ketrenos43f66a62005-03-25 12:31:53 -06002602 copy. Otherwise let the firmware know to perform the operation
Zhu Yic7b6a672006-01-24 16:37:05 +08002603 on its own.
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002604 */
Alexey Dobriyan386093e2006-02-01 03:04:57 -08002605 if (priv->eeprom[EEPROM_VERSION] != 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002606 IPW_DEBUG_INFO("Writing EEPROM data into SRAM\n");
2607
2608 /* write the eeprom data to sram */
James Ketrenosb095c382005-08-24 22:04:42 -05002609 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002610 ipw_write8(priv, IPW_EEPROM_DATA + i, priv->eeprom[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002611
2612 /* Do not load eeprom data on fatal error or suspend */
2613 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
2614 } else {
2615 IPW_DEBUG_INFO("Enabling FW initializationg of SRAM\n");
2616
2617 /* Load eeprom data on fatal error or suspend */
2618 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 1);
2619 }
2620
2621 IPW_DEBUG_TRACE("<<\n");
2622}
2623
Arjan van de Ven858119e2006-01-14 13:20:43 -08002624static void ipw_zero_memory(struct ipw_priv *priv, u32 start, u32 count)
James Ketrenos43f66a62005-03-25 12:31:53 -06002625{
2626 count >>= 2;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002627 if (!count)
2628 return;
James Ketrenosb095c382005-08-24 22:04:42 -05002629 _ipw_write32(priv, IPW_AUTOINC_ADDR, start);
Jeff Garzikbf794512005-07-31 13:07:26 -04002630 while (count--)
James Ketrenosb095c382005-08-24 22:04:42 -05002631 _ipw_write32(priv, IPW_AUTOINC_DATA, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002632}
2633
2634static inline void ipw_fw_dma_reset_command_blocks(struct ipw_priv *priv)
2635{
James Ketrenosb095c382005-08-24 22:04:42 -05002636 ipw_zero_memory(priv, IPW_SHARED_SRAM_DMA_CONTROL,
Jeff Garzikbf794512005-07-31 13:07:26 -04002637 CB_NUMBER_OF_ELEMENTS_SMALL *
James Ketrenos43f66a62005-03-25 12:31:53 -06002638 sizeof(struct command_block));
2639}
2640
2641static int ipw_fw_dma_enable(struct ipw_priv *priv)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002642{ /* start dma engine but no transfers yet */
James Ketrenos43f66a62005-03-25 12:31:53 -06002643
2644 IPW_DEBUG_FW(">> : \n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002645
James Ketrenos43f66a62005-03-25 12:31:53 -06002646 /* Start the dma */
2647 ipw_fw_dma_reset_command_blocks(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04002648
James Ketrenos43f66a62005-03-25 12:31:53 -06002649 /* Write CB base address */
James Ketrenosb095c382005-08-24 22:04:42 -05002650 ipw_write_reg32(priv, IPW_DMA_I_CB_BASE, IPW_SHARED_SRAM_DMA_CONTROL);
James Ketrenos43f66a62005-03-25 12:31:53 -06002651
2652 IPW_DEBUG_FW("<< : \n");
2653 return 0;
2654}
2655
2656static void ipw_fw_dma_abort(struct ipw_priv *priv)
2657{
2658 u32 control = 0;
2659
2660 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002661
Pavel Machek67fd6b42006-07-11 15:34:05 +02002662 /* set the Stop and Abort bit */
James Ketrenos43f66a62005-03-25 12:31:53 -06002663 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_STOP_AND_ABORT;
James Ketrenosb095c382005-08-24 22:04:42 -05002664 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002665 priv->sram_desc.last_cb_index = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04002666
James Ketrenos43f66a62005-03-25 12:31:53 -06002667 IPW_DEBUG_FW("<< \n");
2668}
2669
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002670static int ipw_fw_dma_write_command_block(struct ipw_priv *priv, int index,
2671 struct command_block *cb)
James Ketrenos43f66a62005-03-25 12:31:53 -06002672{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002673 u32 address =
James Ketrenosb095c382005-08-24 22:04:42 -05002674 IPW_SHARED_SRAM_DMA_CONTROL +
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002675 (sizeof(struct command_block) * index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002676 IPW_DEBUG_FW(">> :\n");
2677
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002678 ipw_write_indirect(priv, address, (u8 *) cb,
2679 (int)sizeof(struct command_block));
James Ketrenos43f66a62005-03-25 12:31:53 -06002680
2681 IPW_DEBUG_FW("<< :\n");
2682 return 0;
2683
2684}
2685
2686static int ipw_fw_dma_kick(struct ipw_priv *priv)
2687{
2688 u32 control = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002689 u32 index = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002690
2691 IPW_DEBUG_FW(">> :\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04002692
James Ketrenos43f66a62005-03-25 12:31:53 -06002693 for (index = 0; index < priv->sram_desc.last_cb_index; index++)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002694 ipw_fw_dma_write_command_block(priv, index,
2695 &priv->sram_desc.cb_list[index]);
James Ketrenos43f66a62005-03-25 12:31:53 -06002696
2697 /* Enable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002698 ipw_clear_bit(priv, IPW_RESET_REG,
2699 IPW_RESET_REG_MASTER_DISABLED |
2700 IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04002701
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002702 /* Set the Start bit. */
James Ketrenos43f66a62005-03-25 12:31:53 -06002703 control = DMA_CONTROL_SMALL_CB_CONST_VALUE | DMA_CB_START;
James Ketrenosb095c382005-08-24 22:04:42 -05002704 ipw_write_reg32(priv, IPW_DMA_I_DMA_CONTROL, control);
James Ketrenos43f66a62005-03-25 12:31:53 -06002705
2706 IPW_DEBUG_FW("<< :\n");
2707 return 0;
2708}
2709
2710static void ipw_fw_dma_dump_command_block(struct ipw_priv *priv)
2711{
2712 u32 address;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002713 u32 register_value = 0;
2714 u32 cb_fields_address = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002715
2716 IPW_DEBUG_FW(">> :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002717 address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002718 IPW_DEBUG_FW_INFO("Current CB is 0x%x \n", address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002719
2720 /* Read the DMA Controlor register */
James Ketrenosb095c382005-08-24 22:04:42 -05002721 register_value = ipw_read_reg32(priv, IPW_DMA_I_DMA_CONTROL);
2722 IPW_DEBUG_FW_INFO("IPW_DMA_I_DMA_CONTROL is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002723
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002724 /* Print the CB values */
James Ketrenos43f66a62005-03-25 12:31:53 -06002725 cb_fields_address = address;
2726 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002727 IPW_DEBUG_FW_INFO("Current CB ControlField is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002728
2729 cb_fields_address += sizeof(u32);
2730 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002731 IPW_DEBUG_FW_INFO("Current CB Source Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002732
2733 cb_fields_address += sizeof(u32);
2734 register_value = ipw_read_reg32(priv, cb_fields_address);
2735 IPW_DEBUG_FW_INFO("Current CB Destination Field is 0x%x \n",
2736 register_value);
2737
2738 cb_fields_address += sizeof(u32);
2739 register_value = ipw_read_reg32(priv, cb_fields_address);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002740 IPW_DEBUG_FW_INFO("Current CB Status Field is 0x%x \n", register_value);
James Ketrenos43f66a62005-03-25 12:31:53 -06002741
2742 IPW_DEBUG_FW(">> :\n");
2743}
2744
2745static int ipw_fw_dma_command_block_index(struct ipw_priv *priv)
2746{
2747 u32 current_cb_address = 0;
2748 u32 current_cb_index = 0;
2749
2750 IPW_DEBUG_FW("<< :\n");
James Ketrenosb095c382005-08-24 22:04:42 -05002751 current_cb_address = ipw_read_reg32(priv, IPW_DMA_I_CURRENT_CB);
Jeff Garzikbf794512005-07-31 13:07:26 -04002752
James Ketrenosb095c382005-08-24 22:04:42 -05002753 current_cb_index = (current_cb_address - IPW_SHARED_SRAM_DMA_CONTROL) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002754 sizeof(struct command_block);
Jeff Garzikbf794512005-07-31 13:07:26 -04002755
James Ketrenos43f66a62005-03-25 12:31:53 -06002756 IPW_DEBUG_FW_INFO("Current CB index 0x%x address = 0x%X \n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002757 current_cb_index, current_cb_address);
James Ketrenos43f66a62005-03-25 12:31:53 -06002758
2759 IPW_DEBUG_FW(">> :\n");
2760 return current_cb_index;
2761
2762}
2763
2764static int ipw_fw_dma_add_command_block(struct ipw_priv *priv,
2765 u32 src_address,
2766 u32 dest_address,
2767 u32 length,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002768 int interrupt_enabled, int is_last)
James Ketrenos43f66a62005-03-25 12:31:53 -06002769{
2770
Jeff Garzikbf794512005-07-31 13:07:26 -04002771 u32 control = CB_VALID | CB_SRC_LE | CB_DEST_LE | CB_SRC_AUTOINC |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002772 CB_SRC_IO_GATED | CB_DEST_AUTOINC | CB_SRC_SIZE_LONG |
2773 CB_DEST_SIZE_LONG;
James Ketrenos43f66a62005-03-25 12:31:53 -06002774 struct command_block *cb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002775 u32 last_cb_element = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002776
2777 IPW_DEBUG_FW_INFO("src_address=0x%x dest_address=0x%x length=0x%x\n",
2778 src_address, dest_address, length);
2779
2780 if (priv->sram_desc.last_cb_index >= CB_NUMBER_OF_ELEMENTS_SMALL)
2781 return -1;
2782
2783 last_cb_element = priv->sram_desc.last_cb_index;
2784 cb = &priv->sram_desc.cb_list[last_cb_element];
2785 priv->sram_desc.last_cb_index++;
2786
2787 /* Calculate the new CB control word */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002788 if (interrupt_enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -06002789 control |= CB_INT_ENABLED;
2790
2791 if (is_last)
2792 control |= CB_LAST_VALID;
Jeff Garzikbf794512005-07-31 13:07:26 -04002793
James Ketrenos43f66a62005-03-25 12:31:53 -06002794 control |= length;
2795
2796 /* Calculate the CB Element's checksum value */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002797 cb->status = control ^ src_address ^ dest_address;
James Ketrenos43f66a62005-03-25 12:31:53 -06002798
2799 /* Copy the Source and Destination addresses */
2800 cb->dest_addr = dest_address;
2801 cb->source_addr = src_address;
2802
2803 /* Copy the Control Word last */
2804 cb->control = control;
2805
2806 return 0;
2807}
2808
2809static int ipw_fw_dma_add_buffer(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002810 u32 src_phys, u32 dest_address, u32 length)
James Ketrenos43f66a62005-03-25 12:31:53 -06002811{
2812 u32 bytes_left = length;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002813 u32 src_offset = 0;
2814 u32 dest_offset = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06002815 int status = 0;
2816 IPW_DEBUG_FW(">> \n");
2817 IPW_DEBUG_FW_INFO("src_phys=0x%x dest_address=0x%x length=0x%x\n",
2818 src_phys, dest_address, length);
2819 while (bytes_left > CB_MAX_LENGTH) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002820 status = ipw_fw_dma_add_command_block(priv,
2821 src_phys + src_offset,
2822 dest_address +
2823 dest_offset,
2824 CB_MAX_LENGTH, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002825 if (status) {
2826 IPW_DEBUG_FW_INFO(": Failed\n");
2827 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002828 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06002829 IPW_DEBUG_FW_INFO(": Added new cb\n");
2830
2831 src_offset += CB_MAX_LENGTH;
2832 dest_offset += CB_MAX_LENGTH;
2833 bytes_left -= CB_MAX_LENGTH;
2834 }
2835
2836 /* add the buffer tail */
2837 if (bytes_left > 0) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002838 status =
2839 ipw_fw_dma_add_command_block(priv, src_phys + src_offset,
2840 dest_address + dest_offset,
2841 bytes_left, 0, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06002842 if (status) {
2843 IPW_DEBUG_FW_INFO(": Failed on the buffer tail\n");
2844 return -1;
Jeff Garzikbf794512005-07-31 13:07:26 -04002845 } else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002846 IPW_DEBUG_FW_INFO
2847 (": Adding new cb - the buffer tail\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002848 }
Jeff Garzikbf794512005-07-31 13:07:26 -04002849
James Ketrenos43f66a62005-03-25 12:31:53 -06002850 IPW_DEBUG_FW("<< \n");
2851 return 0;
2852}
2853
2854static int ipw_fw_dma_wait(struct ipw_priv *priv)
2855{
Zhu Yi397ae122006-01-24 16:37:22 +08002856 u32 current_index = 0, previous_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002857 u32 watchdog = 0;
2858
2859 IPW_DEBUG_FW(">> : \n");
2860
2861 current_index = ipw_fw_dma_command_block_index(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08002862 IPW_DEBUG_FW_INFO("sram_desc.last_cb_index:0x%08X\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002863 (int)priv->sram_desc.last_cb_index);
James Ketrenos43f66a62005-03-25 12:31:53 -06002864
2865 while (current_index < priv->sram_desc.last_cb_index) {
2866 udelay(50);
Zhu Yi397ae122006-01-24 16:37:22 +08002867 previous_index = current_index;
James Ketrenos43f66a62005-03-25 12:31:53 -06002868 current_index = ipw_fw_dma_command_block_index(priv);
2869
Zhu Yi397ae122006-01-24 16:37:22 +08002870 if (previous_index < current_index) {
2871 watchdog = 0;
2872 continue;
2873 }
2874 if (++watchdog > 400) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002875 IPW_DEBUG_FW_INFO("Timeout\n");
2876 ipw_fw_dma_dump_command_block(priv);
2877 ipw_fw_dma_abort(priv);
2878 return -1;
2879 }
2880 }
2881
2882 ipw_fw_dma_abort(priv);
2883
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002884 /*Disable the DMA in the CSR register */
James Ketrenosb095c382005-08-24 22:04:42 -05002885 ipw_set_bit(priv, IPW_RESET_REG,
2886 IPW_RESET_REG_MASTER_DISABLED | IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002887
2888 IPW_DEBUG_FW("<< dmaWaitSync \n");
2889 return 0;
2890}
2891
Jeff Garzikbf794512005-07-31 13:07:26 -04002892static void ipw_remove_current_network(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002893{
2894 struct list_head *element, *safe;
Jeff Garzikbf794512005-07-31 13:07:26 -04002895 struct ieee80211_network *network = NULL;
James Ketrenosa613bff2005-08-24 21:43:11 -05002896 unsigned long flags;
2897
2898 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002899 list_for_each_safe(element, safe, &priv->ieee->network_list) {
2900 network = list_entry(element, struct ieee80211_network, list);
2901 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
2902 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04002903 list_add_tail(&network->list,
James Ketrenos43f66a62005-03-25 12:31:53 -06002904 &priv->ieee->network_free_list);
2905 }
2906 }
James Ketrenosa613bff2005-08-24 21:43:11 -05002907 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06002908}
2909
2910/**
Jeff Garzikbf794512005-07-31 13:07:26 -04002911 * Check that card is still alive.
James Ketrenos43f66a62005-03-25 12:31:53 -06002912 * Reads debug register from domain0.
2913 * If card is present, pre-defined value should
2914 * be found there.
Jeff Garzikbf794512005-07-31 13:07:26 -04002915 *
James Ketrenos43f66a62005-03-25 12:31:53 -06002916 * @param priv
2917 * @return 1 if card is present, 0 otherwise
2918 */
2919static inline int ipw_alive(struct ipw_priv *priv)
2920{
2921 return ipw_read32(priv, 0x90) == 0xd55555d5;
2922}
2923
Zhu Yic7b6a672006-01-24 16:37:05 +08002924/* timeout in msec, attempted in 10-msec quanta */
Arjan van de Ven858119e2006-01-14 13:20:43 -08002925static int ipw_poll_bit(struct ipw_priv *priv, u32 addr, u32 mask,
James Ketrenos43f66a62005-03-25 12:31:53 -06002926 int timeout)
2927{
2928 int i = 0;
2929
2930 do {
Jeff Garzikbf794512005-07-31 13:07:26 -04002931 if ((ipw_read32(priv, addr) & mask) == mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06002932 return i;
2933 mdelay(10);
2934 i += 10;
2935 } while (i < timeout);
Jeff Garzikbf794512005-07-31 13:07:26 -04002936
James Ketrenos43f66a62005-03-25 12:31:53 -06002937 return -ETIME;
2938}
2939
Jeff Garzikbf794512005-07-31 13:07:26 -04002940/* These functions load the firmware and micro code for the operation of
James Ketrenos43f66a62005-03-25 12:31:53 -06002941 * the ipw hardware. It assumes the buffer has all the bits for the
2942 * image and the caller is handling the memory allocation and clean up.
2943 */
2944
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002945static int ipw_stop_master(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06002946{
2947 int rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002948
James Ketrenos43f66a62005-03-25 12:31:53 -06002949 IPW_DEBUG_TRACE(">> \n");
2950 /* stop master. typical delay - 0 */
James Ketrenosb095c382005-08-24 22:04:42 -05002951 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06002952
Zhu Yic7b6a672006-01-24 16:37:05 +08002953 /* timeout is in msec, polled in 10-msec quanta */
James Ketrenosb095c382005-08-24 22:04:42 -05002954 rc = ipw_poll_bit(priv, IPW_RESET_REG,
2955 IPW_RESET_REG_MASTER_DISABLED, 100);
James Ketrenos43f66a62005-03-25 12:31:53 -06002956 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08002957 IPW_ERROR("wait for stop master failed after 100ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06002958 return -1;
2959 }
2960
2961 IPW_DEBUG_INFO("stop master %dms\n", rc);
2962
2963 return rc;
2964}
2965
2966static void ipw_arc_release(struct ipw_priv *priv)
2967{
2968 IPW_DEBUG_TRACE(">> \n");
2969 mdelay(5);
2970
James Ketrenosb095c382005-08-24 22:04:42 -05002971 ipw_clear_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06002972
2973 /* no one knows timing, for safety add some delay */
2974 mdelay(5);
2975}
2976
James Ketrenos43f66a62005-03-25 12:31:53 -06002977struct fw_chunk {
2978 u32 address;
2979 u32 length;
2980};
2981
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002982static int ipw_load_ucode(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06002983{
2984 int rc = 0, i, addr;
2985 u8 cr = 0;
2986 u16 *image;
2987
Jeff Garzik0edd5b42005-09-07 00:48:31 -04002988 image = (u16 *) data;
Jeff Garzikbf794512005-07-31 13:07:26 -04002989
James Ketrenos43f66a62005-03-25 12:31:53 -06002990 IPW_DEBUG_TRACE(">> \n");
2991
2992 rc = ipw_stop_master(priv);
2993
2994 if (rc < 0)
2995 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04002996
James Ketrenosb095c382005-08-24 22:04:42 -05002997 for (addr = IPW_SHARED_LOWER_BOUND;
2998 addr < IPW_REGISTER_DOMAIN1_END; addr += 4) {
James Ketrenos43f66a62005-03-25 12:31:53 -06002999 ipw_write32(priv, addr, 0);
3000 }
3001
3002 /* no ucode (yet) */
3003 memset(&priv->dino_alive, 0, sizeof(priv->dino_alive));
3004 /* destroy DMA queues */
3005 /* reset sequence */
3006
James Ketrenosb095c382005-08-24 22:04:42 -05003007 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_ON);
James Ketrenos43f66a62005-03-25 12:31:53 -06003008 ipw_arc_release(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05003009 ipw_write_reg32(priv, IPW_MEM_HALT_AND_RESET, IPW_BIT_HALT_RESET_OFF);
James Ketrenos43f66a62005-03-25 12:31:53 -06003010 mdelay(1);
3011
3012 /* reset PHY */
James Ketrenosb095c382005-08-24 22:04:42 -05003013 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, IPW_BASEBAND_POWER_DOWN);
James Ketrenos43f66a62005-03-25 12:31:53 -06003014 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003015
James Ketrenosb095c382005-08-24 22:04:42 -05003016 ipw_write_reg32(priv, IPW_INTERNAL_CMD_EVENT, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003017 mdelay(1);
Jeff Garzikbf794512005-07-31 13:07:26 -04003018
James Ketrenos43f66a62005-03-25 12:31:53 -06003019 /* enable ucode store */
Zhu Yic8fe6672006-01-24 16:36:36 +08003020 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0x0);
3021 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_CS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003022 mdelay(1);
3023
3024 /* write ucode */
3025 /**
3026 * @bug
3027 * Do NOT set indirect address register once and then
3028 * store data to indirect data register in the loop.
3029 * It seems very reasonable, but in this case DINO do not
3030 * accept ucode. It is essential to set address each time.
3031 */
3032 /* load new ipw uCode */
3033 for (i = 0; i < len / 2; i++)
James Ketrenosb095c382005-08-24 22:04:42 -05003034 ipw_write_reg16(priv, IPW_BASEBAND_CONTROL_STORE,
James Ketrenosa613bff2005-08-24 21:43:11 -05003035 cpu_to_le16(image[i]));
James Ketrenos43f66a62005-03-25 12:31:53 -06003036
James Ketrenos43f66a62005-03-25 12:31:53 -06003037 /* enable DINO */
James Ketrenosb095c382005-08-24 22:04:42 -05003038 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
3039 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, DINO_ENABLE_SYSTEM);
James Ketrenos43f66a62005-03-25 12:31:53 -06003040
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003041 /* this is where the igx / win driver deveates from the VAP driver. */
James Ketrenos43f66a62005-03-25 12:31:53 -06003042
3043 /* wait for alive response */
3044 for (i = 0; i < 100; i++) {
3045 /* poll for incoming data */
James Ketrenosb095c382005-08-24 22:04:42 -05003046 cr = ipw_read_reg8(priv, IPW_BASEBAND_CONTROL_STATUS);
James Ketrenos43f66a62005-03-25 12:31:53 -06003047 if (cr & DINO_RXFIFO_DATA)
3048 break;
3049 mdelay(1);
3050 }
3051
3052 if (cr & DINO_RXFIFO_DATA) {
3053 /* alive_command_responce size is NOT multiple of 4 */
3054 u32 response_buffer[(sizeof(priv->dino_alive) + 3) / 4];
Jeff Garzikbf794512005-07-31 13:07:26 -04003055
3056 for (i = 0; i < ARRAY_SIZE(response_buffer); i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06003057 response_buffer[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -05003058 le32_to_cpu(ipw_read_reg32(priv,
James Ketrenosb095c382005-08-24 22:04:42 -05003059 IPW_BASEBAND_RX_FIFO_READ));
James Ketrenos43f66a62005-03-25 12:31:53 -06003060 memcpy(&priv->dino_alive, response_buffer,
3061 sizeof(priv->dino_alive));
3062 if (priv->dino_alive.alive_command == 1
3063 && priv->dino_alive.ucode_valid == 1) {
3064 rc = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003065 IPW_DEBUG_INFO
3066 ("Microcode OK, rev. %d (0x%x) dev. %d (0x%x) "
3067 "of %02d/%02d/%02d %02d:%02d\n",
3068 priv->dino_alive.software_revision,
3069 priv->dino_alive.software_revision,
3070 priv->dino_alive.device_identifier,
3071 priv->dino_alive.device_identifier,
3072 priv->dino_alive.time_stamp[0],
3073 priv->dino_alive.time_stamp[1],
3074 priv->dino_alive.time_stamp[2],
3075 priv->dino_alive.time_stamp[3],
3076 priv->dino_alive.time_stamp[4]);
James Ketrenos43f66a62005-03-25 12:31:53 -06003077 } else {
3078 IPW_DEBUG_INFO("Microcode is not alive\n");
3079 rc = -EINVAL;
3080 }
3081 } else {
3082 IPW_DEBUG_INFO("No alive response from DINO\n");
3083 rc = -ETIME;
3084 }
3085
3086 /* disable DINO, otherwise for some reason
3087 firmware have problem getting alive resp. */
James Ketrenosb095c382005-08-24 22:04:42 -05003088 ipw_write_reg8(priv, IPW_BASEBAND_CONTROL_STATUS, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06003089
James Ketrenos43f66a62005-03-25 12:31:53 -06003090 return rc;
3091}
3092
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003093static int ipw_load_firmware(struct ipw_priv *priv, u8 * data, size_t len)
James Ketrenos43f66a62005-03-25 12:31:53 -06003094{
3095 int rc = -1;
3096 int offset = 0;
3097 struct fw_chunk *chunk;
3098 dma_addr_t shared_phys;
3099 u8 *shared_virt;
3100
3101 IPW_DEBUG_TRACE("<< : \n");
3102 shared_virt = pci_alloc_consistent(priv->pci_dev, len, &shared_phys);
3103
3104 if (!shared_virt)
3105 return -ENOMEM;
3106
3107 memmove(shared_virt, data, len);
3108
3109 /* Start the Dma */
3110 rc = ipw_fw_dma_enable(priv);
3111
3112 if (priv->sram_desc.last_cb_index > 0) {
3113 /* the DMA is already ready this would be a bug. */
3114 BUG();
3115 goto out;
3116 }
3117
3118 do {
3119 chunk = (struct fw_chunk *)(data + offset);
3120 offset += sizeof(struct fw_chunk);
3121 /* build DMA packet and queue up for sending */
Jeff Garzikbf794512005-07-31 13:07:26 -04003122 /* dma to chunk->address, the chunk->length bytes from data +
James Ketrenos43f66a62005-03-25 12:31:53 -06003123 * offeset*/
3124 /* Dma loading */
3125 rc = ipw_fw_dma_add_buffer(priv, shared_phys + offset,
James Ketrenosa613bff2005-08-24 21:43:11 -05003126 le32_to_cpu(chunk->address),
3127 le32_to_cpu(chunk->length));
James Ketrenos43f66a62005-03-25 12:31:53 -06003128 if (rc) {
3129 IPW_DEBUG_INFO("dmaAddBuffer Failed\n");
3130 goto out;
3131 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003132
James Ketrenosa613bff2005-08-24 21:43:11 -05003133 offset += le32_to_cpu(chunk->length);
James Ketrenos43f66a62005-03-25 12:31:53 -06003134 } while (offset < len);
3135
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003136 /* Run the DMA and wait for the answer */
James Ketrenos43f66a62005-03-25 12:31:53 -06003137 rc = ipw_fw_dma_kick(priv);
3138 if (rc) {
3139 IPW_ERROR("dmaKick Failed\n");
3140 goto out;
3141 }
3142
3143 rc = ipw_fw_dma_wait(priv);
3144 if (rc) {
3145 IPW_ERROR("dmaWaitSync Failed\n");
3146 goto out;
3147 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003148 out:
3149 pci_free_consistent(priv->pci_dev, len, shared_virt, shared_phys);
James Ketrenos43f66a62005-03-25 12:31:53 -06003150 return rc;
3151}
3152
3153/* stop nic */
3154static int ipw_stop_nic(struct ipw_priv *priv)
3155{
3156 int rc = 0;
3157
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003158 /* stop */
James Ketrenosb095c382005-08-24 22:04:42 -05003159 ipw_write32(priv, IPW_RESET_REG, IPW_RESET_REG_STOP_MASTER);
Jeff Garzikbf794512005-07-31 13:07:26 -04003160
James Ketrenosb095c382005-08-24 22:04:42 -05003161 rc = ipw_poll_bit(priv, IPW_RESET_REG,
3162 IPW_RESET_REG_MASTER_DISABLED, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003163 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003164 IPW_ERROR("wait for reg master disabled failed after 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003165 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003166 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003167
James Ketrenosb095c382005-08-24 22:04:42 -05003168 ipw_set_bit(priv, IPW_RESET_REG, CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003169
James Ketrenos43f66a62005-03-25 12:31:53 -06003170 return rc;
3171}
3172
3173static void ipw_start_nic(struct ipw_priv *priv)
3174{
3175 IPW_DEBUG_TRACE(">>\n");
3176
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003177 /* prvHwStartNic release ARC */
James Ketrenosb095c382005-08-24 22:04:42 -05003178 ipw_clear_bit(priv, IPW_RESET_REG,
3179 IPW_RESET_REG_MASTER_DISABLED |
3180 IPW_RESET_REG_STOP_MASTER |
James Ketrenos43f66a62005-03-25 12:31:53 -06003181 CBD_RESET_REG_PRINCETON_RESET);
Jeff Garzikbf794512005-07-31 13:07:26 -04003182
James Ketrenos43f66a62005-03-25 12:31:53 -06003183 /* enable power management */
James Ketrenosb095c382005-08-24 22:04:42 -05003184 ipw_set_bit(priv, IPW_GP_CNTRL_RW,
3185 IPW_GP_CNTRL_BIT_HOST_ALLOWS_STANDBY);
James Ketrenos43f66a62005-03-25 12:31:53 -06003186
3187 IPW_DEBUG_TRACE("<<\n");
3188}
Jeff Garzikbf794512005-07-31 13:07:26 -04003189
James Ketrenos43f66a62005-03-25 12:31:53 -06003190static int ipw_init_nic(struct ipw_priv *priv)
3191{
3192 int rc;
3193
3194 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003195 /* reset */
James Ketrenos43f66a62005-03-25 12:31:53 -06003196 /*prvHwInitNic */
3197 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003198 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003199
3200 /* low-level PLL activation */
James Ketrenosb095c382005-08-24 22:04:42 -05003201 ipw_write32(priv, IPW_READ_INT_REGISTER,
3202 IPW_BIT_INT_HOST_SRAM_READ_INT_REGISTER);
James Ketrenos43f66a62005-03-25 12:31:53 -06003203
3204 /* wait for clock stabilization */
James Ketrenosb095c382005-08-24 22:04:42 -05003205 rc = ipw_poll_bit(priv, IPW_GP_CNTRL_RW,
3206 IPW_GP_CNTRL_BIT_CLOCK_READY, 250);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003207 if (rc < 0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003208 IPW_DEBUG_INFO("FAILED wait for clock stablization\n");
3209
3210 /* assert SW reset */
James Ketrenosb095c382005-08-24 22:04:42 -05003211 ipw_set_bit(priv, IPW_RESET_REG, IPW_RESET_REG_SW_RESET);
James Ketrenos43f66a62005-03-25 12:31:53 -06003212
3213 udelay(10);
3214
3215 /* set "initialization complete" bit to move adapter to D0 state */
James Ketrenosb095c382005-08-24 22:04:42 -05003216 ipw_set_bit(priv, IPW_GP_CNTRL_RW, IPW_GP_CNTRL_BIT_INIT_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003217
3218 IPW_DEBUG_TRACE(">>\n");
3219 return 0;
3220}
3221
Jeff Garzikbf794512005-07-31 13:07:26 -04003222/* Call this function from process context, it will sleep in request_firmware.
James Ketrenos43f66a62005-03-25 12:31:53 -06003223 * Probe is an ok place to call this from.
3224 */
3225static int ipw_reset_nic(struct ipw_priv *priv)
3226{
3227 int rc = 0;
James Ketrenosa613bff2005-08-24 21:43:11 -05003228 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06003229
3230 IPW_DEBUG_TRACE(">>\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04003231
James Ketrenos43f66a62005-03-25 12:31:53 -06003232 rc = ipw_init_nic(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -04003233
James Ketrenosa613bff2005-08-24 21:43:11 -05003234 spin_lock_irqsave(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003235 /* Clear the 'host command active' bit... */
3236 priv->status &= ~STATUS_HCMD_ACTIVE;
3237 wake_up_interruptible(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -05003238 priv->status &= ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
3239 wake_up_interruptible(&priv->wait_state);
James Ketrenosa613bff2005-08-24 21:43:11 -05003240 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06003241
3242 IPW_DEBUG_TRACE("<<\n");
3243 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003244}
James Ketrenos43f66a62005-03-25 12:31:53 -06003245
James Ketrenos9006ea72006-03-08 03:22:28 +08003246
3247struct ipw_fw {
Zhu Yi0070f8c2006-04-13 17:20:12 +08003248 __le32 ver;
3249 __le32 boot_size;
3250 __le32 ucode_size;
3251 __le32 fw_size;
James Ketrenos9006ea72006-03-08 03:22:28 +08003252 u8 data[0];
3253};
3254
Jeff Garzikbf794512005-07-31 13:07:26 -04003255static int ipw_get_fw(struct ipw_priv *priv,
James Ketrenos9006ea72006-03-08 03:22:28 +08003256 const struct firmware **raw, const char *name)
James Ketrenos43f66a62005-03-25 12:31:53 -06003257{
James Ketrenos9006ea72006-03-08 03:22:28 +08003258 struct ipw_fw *fw;
James Ketrenos43f66a62005-03-25 12:31:53 -06003259 int rc;
3260
3261 /* ask firmware_class module to get the boot firmware off disk */
James Ketrenos9006ea72006-03-08 03:22:28 +08003262 rc = request_firmware(raw, name, &priv->pci_dev->dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06003263 if (rc < 0) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003264 IPW_ERROR("%s request_firmware failed: Reason %d\n", name, rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003265 return rc;
Jeff Garzikbf794512005-07-31 13:07:26 -04003266 }
James Ketrenos43f66a62005-03-25 12:31:53 -06003267
James Ketrenos9006ea72006-03-08 03:22:28 +08003268 if ((*raw)->size < sizeof(*fw)) {
3269 IPW_ERROR("%s is too small (%zd)\n", name, (*raw)->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06003270 return -EINVAL;
3271 }
3272
James Ketrenos9006ea72006-03-08 03:22:28 +08003273 fw = (void *)(*raw)->data;
3274
Zhu Yi0070f8c2006-04-13 17:20:12 +08003275 if ((*raw)->size < sizeof(*fw) + le32_to_cpu(fw->boot_size) +
3276 le32_to_cpu(fw->ucode_size) + le32_to_cpu(fw->fw_size)) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003277 IPW_ERROR("%s is too small or corrupt (%zd)\n",
3278 name, (*raw)->size);
3279 return -EINVAL;
3280 }
3281
3282 IPW_DEBUG_INFO("Read firmware '%s' image v%d.%d (%zd bytes)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06003283 name,
James Ketrenos9006ea72006-03-08 03:22:28 +08003284 le32_to_cpu(fw->ver) >> 16,
3285 le32_to_cpu(fw->ver) & 0xff,
3286 (*raw)->size - sizeof(*fw));
James Ketrenos43f66a62005-03-25 12:31:53 -06003287 return 0;
3288}
3289
James Ketrenosb095c382005-08-24 22:04:42 -05003290#define IPW_RX_BUF_SIZE (3000)
James Ketrenos43f66a62005-03-25 12:31:53 -06003291
Arjan van de Ven858119e2006-01-14 13:20:43 -08003292static void ipw_rx_queue_reset(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003293 struct ipw_rx_queue *rxq)
3294{
3295 unsigned long flags;
3296 int i;
3297
3298 spin_lock_irqsave(&rxq->lock, flags);
3299
3300 INIT_LIST_HEAD(&rxq->rx_free);
3301 INIT_LIST_HEAD(&rxq->rx_used);
3302
3303 /* Fill the rx_used queue with _all_ of the Rx buffers */
3304 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++) {
3305 /* In the reset function, these buffers may have been allocated
3306 * to an SKB, so we need to unmap and free potential storage */
3307 if (rxq->pool[i].skb != NULL) {
3308 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05003309 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003310 dev_kfree_skb(rxq->pool[i].skb);
James Ketrenosa613bff2005-08-24 21:43:11 -05003311 rxq->pool[i].skb = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003312 }
3313 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
3314 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003315
James Ketrenos43f66a62005-03-25 12:31:53 -06003316 /* Set us so that we have processed and used all buffers, but have
3317 * not restocked the Rx queue with fresh buffers */
3318 rxq->read = rxq->write = 0;
3319 rxq->processed = RX_QUEUE_SIZE - 1;
3320 rxq->free_count = 0;
3321 spin_unlock_irqrestore(&rxq->lock, flags);
3322}
3323
3324#ifdef CONFIG_PM
3325static int fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003326static const struct firmware *raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003327
3328static void free_firmware(void)
3329{
3330 if (fw_loaded) {
James Ketrenos9006ea72006-03-08 03:22:28 +08003331 release_firmware(raw);
3332 raw = NULL;
James Ketrenosafbf30a2005-08-25 00:05:33 -05003333 fw_loaded = 0;
3334 }
3335}
3336#else
3337#define free_firmware() do {} while (0)
James Ketrenos43f66a62005-03-25 12:31:53 -06003338#endif
3339
3340static int ipw_load(struct ipw_priv *priv)
3341{
3342#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003343 const struct firmware *raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003344#endif
James Ketrenos9006ea72006-03-08 03:22:28 +08003345 struct ipw_fw *fw;
3346 u8 *boot_img, *ucode_img, *fw_img;
3347 u8 *name = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003348 int rc = 0, retries = 3;
3349
Zhu Yi397ae122006-01-24 16:37:22 +08003350 switch (priv->ieee->iw_mode) {
3351 case IW_MODE_ADHOC:
James Ketrenos9006ea72006-03-08 03:22:28 +08003352 name = "ipw2200-ibss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003353 break;
James Ketrenosb095c382005-08-24 22:04:42 -05003354#ifdef CONFIG_IPW2200_MONITOR
Zhu Yi397ae122006-01-24 16:37:22 +08003355 case IW_MODE_MONITOR:
James Ketrenos9006ea72006-03-08 03:22:28 +08003356 name = "ipw2200-sniffer.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003357 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003358#endif
Zhu Yi397ae122006-01-24 16:37:22 +08003359 case IW_MODE_INFRA:
James Ketrenos9006ea72006-03-08 03:22:28 +08003360 name = "ipw2200-bss.fw";
Zhu Yi397ae122006-01-24 16:37:22 +08003361 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06003362 }
Zhu Yi397ae122006-01-24 16:37:22 +08003363
James Ketrenos9006ea72006-03-08 03:22:28 +08003364 if (!name) {
3365 rc = -EINVAL;
3366 goto error;
3367 }
3368
3369#ifdef CONFIG_PM
3370 if (!fw_loaded) {
3371#endif
3372 rc = ipw_get_fw(priv, &raw, name);
3373 if (rc < 0)
3374 goto error;
3375#ifdef CONFIG_PM
3376 }
3377#endif
3378
3379 fw = (void *)raw->data;
3380 boot_img = &fw->data[0];
Zhu Yi0070f8c2006-04-13 17:20:12 +08003381 ucode_img = &fw->data[le32_to_cpu(fw->boot_size)];
3382 fw_img = &fw->data[le32_to_cpu(fw->boot_size) +
3383 le32_to_cpu(fw->ucode_size)];
James Ketrenos9006ea72006-03-08 03:22:28 +08003384
Zhu Yi397ae122006-01-24 16:37:22 +08003385 if (rc < 0)
3386 goto error;
James Ketrenos43f66a62005-03-25 12:31:53 -06003387
3388 if (!priv->rxq)
3389 priv->rxq = ipw_rx_queue_alloc(priv);
3390 else
3391 ipw_rx_queue_reset(priv, priv->rxq);
3392 if (!priv->rxq) {
3393 IPW_ERROR("Unable to initialize Rx queue\n");
3394 goto error;
3395 }
3396
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003397 retry:
James Ketrenos43f66a62005-03-25 12:31:53 -06003398 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003399 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003400 priv->status &= ~STATUS_INT_ENABLED;
3401
3402 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003403 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003404
James Ketrenos43f66a62005-03-25 12:31:53 -06003405 ipw_stop_nic(priv);
3406
3407 rc = ipw_reset_nic(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003408 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003409 IPW_ERROR("Unable to reset NIC\n");
3410 goto error;
3411 }
3412
James Ketrenosb095c382005-08-24 22:04:42 -05003413 ipw_zero_memory(priv, IPW_NIC_SRAM_LOWER_BOUND,
3414 IPW_NIC_SRAM_UPPER_BOUND - IPW_NIC_SRAM_LOWER_BOUND);
James Ketrenos43f66a62005-03-25 12:31:53 -06003415
3416 /* DMA the initial boot firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003417 rc = ipw_load_firmware(priv, boot_img, le32_to_cpu(fw->boot_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003418 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003419 IPW_ERROR("Unable to load boot firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003420 goto error;
3421 }
3422
3423 /* kick start the device */
3424 ipw_start_nic(priv);
3425
Zhu Yic7b6a672006-01-24 16:37:05 +08003426 /* wait for the device to finish its initial startup sequence */
James Ketrenosb095c382005-08-24 22:04:42 -05003427 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3428 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003429 if (rc < 0) {
3430 IPW_ERROR("device failed to boot initial fw image\n");
3431 goto error;
3432 }
3433 IPW_DEBUG_INFO("initial device response after %dms\n", rc);
3434
Jeff Garzikbf794512005-07-31 13:07:26 -04003435 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003436 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003437
3438 /* DMA the ucode into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003439 rc = ipw_load_ucode(priv, ucode_img, le32_to_cpu(fw->ucode_size));
James Ketrenos43f66a62005-03-25 12:31:53 -06003440 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003441 IPW_ERROR("Unable to load ucode: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003442 goto error;
3443 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003444
James Ketrenos43f66a62005-03-25 12:31:53 -06003445 /* stop nic */
3446 ipw_stop_nic(priv);
3447
3448 /* DMA bss firmware into the device */
Zhu Yi0070f8c2006-04-13 17:20:12 +08003449 rc = ipw_load_firmware(priv, fw_img, le32_to_cpu(fw->fw_size));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003450 if (rc < 0) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -05003451 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -06003452 goto error;
3453 }
Zhu Yi397ae122006-01-24 16:37:22 +08003454#ifdef CONFIG_PM
3455 fw_loaded = 1;
3456#endif
3457
James Ketrenos43f66a62005-03-25 12:31:53 -06003458 ipw_write32(priv, IPW_EEPROM_LOAD_DISABLE, 0);
3459
3460 rc = ipw_queue_reset(priv);
Zhu Yi397ae122006-01-24 16:37:22 +08003461 if (rc < 0) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003462 IPW_ERROR("Unable to initialize queues\n");
3463 goto error;
3464 }
3465
3466 /* Ensure interrupts are disabled */
James Ketrenosb095c382005-08-24 22:04:42 -05003467 ipw_write32(priv, IPW_INTA_MASK_R, ~IPW_INTA_MASK_ALL);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003468 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003469 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
Jeff Garzikbf794512005-07-31 13:07:26 -04003470
James Ketrenos43f66a62005-03-25 12:31:53 -06003471 /* kick start the device */
3472 ipw_start_nic(priv);
3473
James Ketrenosb095c382005-08-24 22:04:42 -05003474 if (ipw_read32(priv, IPW_INTA_RW) & IPW_INTA_BIT_PARITY_ERROR) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003475 if (retries > 0) {
3476 IPW_WARNING("Parity error. Retrying init.\n");
3477 retries--;
3478 goto retry;
3479 }
3480
3481 IPW_ERROR("TODO: Handle parity error -- schedule restart?\n");
3482 rc = -EIO;
3483 goto error;
3484 }
3485
3486 /* wait for the device */
James Ketrenosb095c382005-08-24 22:04:42 -05003487 rc = ipw_poll_bit(priv, IPW_INTA_RW,
3488 IPW_INTA_BIT_FW_INITIALIZATION_DONE, 500);
James Ketrenos43f66a62005-03-25 12:31:53 -06003489 if (rc < 0) {
Zhu Yic7b6a672006-01-24 16:37:05 +08003490 IPW_ERROR("device failed to start within 500ms\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06003491 goto error;
3492 }
3493 IPW_DEBUG_INFO("device response after %dms\n", rc);
3494
3495 /* ack fw init done interrupt */
James Ketrenosb095c382005-08-24 22:04:42 -05003496 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_BIT_FW_INITIALIZATION_DONE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003497
3498 /* read eeprom data and initialize the eeprom region of sram */
3499 priv->eeprom_delay = 1;
Jeff Garzikbf794512005-07-31 13:07:26 -04003500 ipw_eeprom_init_sram(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003501
3502 /* enable interrupts */
3503 ipw_enable_interrupts(priv);
3504
3505 /* Ensure our queue has valid packets */
3506 ipw_rx_queue_replenish(priv);
3507
James Ketrenosb095c382005-08-24 22:04:42 -05003508 ipw_write32(priv, IPW_RX_READ_INDEX, priv->rxq->read);
James Ketrenos43f66a62005-03-25 12:31:53 -06003509
3510 /* ack pending interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -05003511 ipw_write32(priv, IPW_INTA_RW, IPW_INTA_MASK_ALL);
James Ketrenos43f66a62005-03-25 12:31:53 -06003512
3513#ifndef CONFIG_PM
James Ketrenos9006ea72006-03-08 03:22:28 +08003514 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003515#endif
3516 return 0;
3517
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003518 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06003519 if (priv->rxq) {
3520 ipw_rx_queue_free(priv, priv->rxq);
3521 priv->rxq = NULL;
3522 }
3523 ipw_tx_queue_free(priv);
James Ketrenos9006ea72006-03-08 03:22:28 +08003524 if (raw)
3525 release_firmware(raw);
James Ketrenos43f66a62005-03-25 12:31:53 -06003526#ifdef CONFIG_PM
3527 fw_loaded = 0;
James Ketrenos9006ea72006-03-08 03:22:28 +08003528 raw = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -06003529#endif
3530
3531 return rc;
3532}
3533
Jeff Garzikbf794512005-07-31 13:07:26 -04003534/**
James Ketrenos43f66a62005-03-25 12:31:53 -06003535 * DMA services
3536 *
3537 * Theory of operation
3538 *
3539 * A queue is a circular buffers with 'Read' and 'Write' pointers.
3540 * 2 empty entries always kept in the buffer to protect from overflow.
3541 *
3542 * For Tx queue, there are low mark and high mark limits. If, after queuing
Jeff Garzikbf794512005-07-31 13:07:26 -04003543 * the packet for Tx, free space become < low mark, Tx queue stopped. When
3544 * reclaiming packets (on 'tx done IRQ), if free space become > high mark,
James Ketrenos43f66a62005-03-25 12:31:53 -06003545 * Tx queue resumed.
3546 *
3547 * The IPW operates with six queues, one receive queue in the device's
3548 * sram, one transmit queue for sending commands to the device firmware,
Jeff Garzikbf794512005-07-31 13:07:26 -04003549 * and four transmit queues for data.
James Ketrenos43f66a62005-03-25 12:31:53 -06003550 *
Jeff Garzikbf794512005-07-31 13:07:26 -04003551 * The four transmit queues allow for performing quality of service (qos)
James Ketrenos43f66a62005-03-25 12:31:53 -06003552 * transmissions as per the 802.11 protocol. Currently Linux does not
Jeff Garzikbf794512005-07-31 13:07:26 -04003553 * provide a mechanism to the user for utilizing prioritized queues, so
James Ketrenos43f66a62005-03-25 12:31:53 -06003554 * we only utilize the first data transmit queue (queue1).
3555 */
3556
3557/**
3558 * Driver allocates buffers of this size for Rx
3559 */
3560
3561static inline int ipw_queue_space(const struct clx2_queue *q)
3562{
3563 int s = q->last_used - q->first_empty;
3564 if (s <= 0)
3565 s += q->n_bd;
3566 s -= 2; /* keep some reserve to not confuse empty and full situations */
3567 if (s < 0)
3568 s = 0;
3569 return s;
3570}
3571
3572static inline int ipw_queue_inc_wrap(int index, int n_bd)
3573{
3574 return (++index == n_bd) ? 0 : index;
3575}
3576
3577/**
3578 * Initialize common DMA queue structure
Jeff Garzikbf794512005-07-31 13:07:26 -04003579 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003580 * @param q queue to init
3581 * @param count Number of BD's to allocate. Should be power of 2
3582 * @param read_register Address for 'read' register
3583 * (not offset within BAR, full address)
3584 * @param write_register Address for 'write' register
3585 * (not offset within BAR, full address)
3586 * @param base_register Address for 'base' register
3587 * (not offset within BAR, full address)
3588 * @param size Address for 'size' register
3589 * (not offset within BAR, full address)
3590 */
Jeff Garzikbf794512005-07-31 13:07:26 -04003591static void ipw_queue_init(struct ipw_priv *priv, struct clx2_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003592 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003593{
3594 q->n_bd = count;
3595
3596 q->low_mark = q->n_bd / 4;
3597 if (q->low_mark < 4)
3598 q->low_mark = 4;
3599
3600 q->high_mark = q->n_bd / 8;
3601 if (q->high_mark < 2)
3602 q->high_mark = 2;
3603
3604 q->first_empty = q->last_used = 0;
3605 q->reg_r = read;
3606 q->reg_w = write;
3607
3608 ipw_write32(priv, base, q->dma_addr);
3609 ipw_write32(priv, size, count);
3610 ipw_write32(priv, read, 0);
3611 ipw_write32(priv, write, 0);
3612
3613 _ipw_read32(priv, 0x90);
3614}
3615
Jeff Garzikbf794512005-07-31 13:07:26 -04003616static int ipw_queue_tx_init(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06003617 struct clx2_tx_queue *q,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003618 int count, u32 read, u32 write, u32 base, u32 size)
James Ketrenos43f66a62005-03-25 12:31:53 -06003619{
3620 struct pci_dev *dev = priv->pci_dev;
3621
3622 q->txb = kmalloc(sizeof(q->txb[0]) * count, GFP_KERNEL);
3623 if (!q->txb) {
3624 IPW_ERROR("vmalloc for auxilary BD structures failed\n");
3625 return -ENOMEM;
3626 }
3627
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003628 q->bd =
3629 pci_alloc_consistent(dev, sizeof(q->bd[0]) * count, &q->q.dma_addr);
James Ketrenos43f66a62005-03-25 12:31:53 -06003630 if (!q->bd) {
Jiri Bencaaa4d302005-06-07 14:58:41 +02003631 IPW_ERROR("pci_alloc_consistent(%zd) failed\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003632 sizeof(q->bd[0]) * count);
James Ketrenos43f66a62005-03-25 12:31:53 -06003633 kfree(q->txb);
3634 q->txb = NULL;
3635 return -ENOMEM;
3636 }
3637
3638 ipw_queue_init(priv, &q->q, count, read, write, base, size);
3639 return 0;
3640}
3641
3642/**
3643 * Free one TFD, those at index [txq->q.last_used].
3644 * Do NOT advance any indexes
Jeff Garzikbf794512005-07-31 13:07:26 -04003645 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003646 * @param dev
3647 * @param txq
3648 */
3649static void ipw_queue_tx_free_tfd(struct ipw_priv *priv,
3650 struct clx2_tx_queue *txq)
3651{
3652 struct tfd_frame *bd = &txq->bd[txq->q.last_used];
3653 struct pci_dev *dev = priv->pci_dev;
3654 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003655
James Ketrenos43f66a62005-03-25 12:31:53 -06003656 /* classify bd */
3657 if (bd->control_flags.message_type == TX_HOST_COMMAND_TYPE)
3658 /* nothing to cleanup after for host commands */
3659 return;
3660
3661 /* sanity check */
James Ketrenosa613bff2005-08-24 21:43:11 -05003662 if (le32_to_cpu(bd->u.data.num_chunks) > NUM_TFD_CHUNKS) {
3663 IPW_ERROR("Too many chunks: %i\n",
3664 le32_to_cpu(bd->u.data.num_chunks));
James Ketrenos43f66a62005-03-25 12:31:53 -06003665 /** @todo issue fatal error, it is quite serious situation */
3666 return;
3667 }
3668
3669 /* unmap chunks if any */
James Ketrenosa613bff2005-08-24 21:43:11 -05003670 for (i = 0; i < le32_to_cpu(bd->u.data.num_chunks); i++) {
3671 pci_unmap_single(dev, le32_to_cpu(bd->u.data.chunk_ptr[i]),
3672 le16_to_cpu(bd->u.data.chunk_len[i]),
3673 PCI_DMA_TODEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06003674 if (txq->txb[txq->q.last_used]) {
3675 ieee80211_txb_free(txq->txb[txq->q.last_used]);
3676 txq->txb[txq->q.last_used] = NULL;
3677 }
3678 }
3679}
3680
3681/**
3682 * Deallocate DMA queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04003683 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003684 * Empty queue by removing and destroying all BD's.
3685 * Free all buffers.
Jeff Garzikbf794512005-07-31 13:07:26 -04003686 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003687 * @param dev
3688 * @param q
3689 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003690static void ipw_queue_tx_free(struct ipw_priv *priv, struct clx2_tx_queue *txq)
James Ketrenos43f66a62005-03-25 12:31:53 -06003691{
3692 struct clx2_queue *q = &txq->q;
3693 struct pci_dev *dev = priv->pci_dev;
3694
Jeff Garzikbf794512005-07-31 13:07:26 -04003695 if (q->n_bd == 0)
3696 return;
James Ketrenos43f66a62005-03-25 12:31:53 -06003697
3698 /* first, empty all BD's */
3699 for (; q->first_empty != q->last_used;
3700 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
3701 ipw_queue_tx_free_tfd(priv, txq);
3702 }
Jeff Garzikbf794512005-07-31 13:07:26 -04003703
James Ketrenos43f66a62005-03-25 12:31:53 -06003704 /* free buffers belonging to queue itself */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003705 pci_free_consistent(dev, sizeof(txq->bd[0]) * q->n_bd, txq->bd,
James Ketrenos43f66a62005-03-25 12:31:53 -06003706 q->dma_addr);
3707 kfree(txq->txb);
3708
3709 /* 0 fill whole structure */
3710 memset(txq, 0, sizeof(*txq));
3711}
3712
James Ketrenos43f66a62005-03-25 12:31:53 -06003713/**
3714 * Destroy all DMA queues and structures
Jeff Garzikbf794512005-07-31 13:07:26 -04003715 *
James Ketrenos43f66a62005-03-25 12:31:53 -06003716 * @param priv
3717 */
3718static void ipw_tx_queue_free(struct ipw_priv *priv)
3719{
3720 /* Tx CMD queue */
3721 ipw_queue_tx_free(priv, &priv->txq_cmd);
3722
3723 /* Tx queues */
3724 ipw_queue_tx_free(priv, &priv->txq[0]);
3725 ipw_queue_tx_free(priv, &priv->txq[1]);
3726 ipw_queue_tx_free(priv, &priv->txq[2]);
3727 ipw_queue_tx_free(priv, &priv->txq[3]);
3728}
3729
Arjan van de Ven858119e2006-01-14 13:20:43 -08003730static void ipw_create_bssid(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003731{
3732 /* First 3 bytes are manufacturer */
3733 bssid[0] = priv->mac_addr[0];
3734 bssid[1] = priv->mac_addr[1];
3735 bssid[2] = priv->mac_addr[2];
3736
3737 /* Last bytes are random */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003738 get_random_bytes(&bssid[3], ETH_ALEN - 3);
James Ketrenos43f66a62005-03-25 12:31:53 -06003739
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003740 bssid[0] &= 0xfe; /* clear multicast bit */
3741 bssid[0] |= 0x02; /* set local assignment bit (IEEE802) */
James Ketrenos43f66a62005-03-25 12:31:53 -06003742}
3743
Arjan van de Ven858119e2006-01-14 13:20:43 -08003744static u8 ipw_add_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003745{
3746 struct ipw_station_entry entry;
3747 int i;
3748
3749 for (i = 0; i < priv->num_stations; i++) {
3750 if (!memcmp(priv->stations[i], bssid, ETH_ALEN)) {
3751 /* Another node is active in network */
3752 priv->missed_adhoc_beacons = 0;
3753 if (!(priv->config & CFG_STATIC_CHANNEL))
3754 /* when other nodes drop out, we drop out */
3755 priv->config &= ~CFG_ADHOC_PERSIST;
3756
3757 return i;
3758 }
3759 }
3760
3761 if (i == MAX_STATIONS)
3762 return IPW_INVALID_STATION;
3763
3764 IPW_DEBUG_SCAN("Adding AdHoc station: " MAC_FMT "\n", MAC_ARG(bssid));
3765
3766 entry.reserved = 0;
3767 entry.support_mode = 0;
3768 memcpy(entry.mac_addr, bssid, ETH_ALEN);
3769 memcpy(priv->stations[i], bssid, ETH_ALEN);
3770 ipw_write_direct(priv, IPW_STATION_TABLE_LOWER + i * sizeof(entry),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003771 &entry, sizeof(entry));
James Ketrenos43f66a62005-03-25 12:31:53 -06003772 priv->num_stations++;
3773
3774 return i;
3775}
3776
Arjan van de Ven858119e2006-01-14 13:20:43 -08003777static u8 ipw_find_station(struct ipw_priv *priv, u8 * bssid)
James Ketrenos43f66a62005-03-25 12:31:53 -06003778{
3779 int i;
3780
Jeff Garzikbf794512005-07-31 13:07:26 -04003781 for (i = 0; i < priv->num_stations; i++)
3782 if (!memcmp(priv->stations[i], bssid, ETH_ALEN))
James Ketrenos43f66a62005-03-25 12:31:53 -06003783 return i;
3784
3785 return IPW_INVALID_STATION;
3786}
3787
3788static void ipw_send_disassociate(struct ipw_priv *priv, int quiet)
3789{
3790 int err;
3791
Hong Liu7b996592005-08-25 17:36:13 +08003792 if (priv->status & STATUS_ASSOCIATING) {
3793 IPW_DEBUG_ASSOC("Disassociating while associating.\n");
3794 queue_work(priv->workqueue, &priv->disassociate);
3795 return;
3796 }
3797
3798 if (!(priv->status & STATUS_ASSOCIATED)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06003799 IPW_DEBUG_ASSOC("Disassociating while not associated.\n");
3800 return;
3801 }
3802
3803 IPW_DEBUG_ASSOC("Disassocation attempt from " MAC_FMT " "
3804 "on channel %d.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04003805 MAC_ARG(priv->assoc_request.bssid),
James Ketrenos43f66a62005-03-25 12:31:53 -06003806 priv->assoc_request.channel);
3807
3808 priv->status &= ~(STATUS_ASSOCIATING | STATUS_ASSOCIATED);
3809 priv->status |= STATUS_DISASSOCIATING;
3810
3811 if (quiet)
3812 priv->assoc_request.assoc_type = HC_DISASSOC_QUIET;
3813 else
3814 priv->assoc_request.assoc_type = HC_DISASSOCIATE;
Hong Liue6324722005-09-14 21:04:15 -05003815
James Ketrenos43f66a62005-03-25 12:31:53 -06003816 err = ipw_send_associate(priv, &priv->assoc_request);
3817 if (err) {
3818 IPW_DEBUG_HC("Attempt to send [dis]associate command "
3819 "failed.\n");
3820 return;
3821 }
3822
3823}
3824
James Ketrenosc848d0a2005-08-24 21:56:24 -05003825static int ipw_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003826{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003827 struct ipw_priv *priv = data;
3828 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)))
3829 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06003830 ipw_send_disassociate(data, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003831 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003832}
3833
James Ketrenosc848d0a2005-08-24 21:56:24 -05003834static void ipw_bg_disassociate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06003835{
James Ketrenosc848d0a2005-08-24 21:56:24 -05003836 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08003837 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05003838 ipw_disassociate(data);
Zhu Yi46441512006-01-24 16:37:59 +08003839 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06003840}
3841
Zhu Yid8bad6d2005-07-13 12:25:38 -05003842static void ipw_system_config(void *data)
3843{
3844 struct ipw_priv *priv = data;
Zhu Yid685b8c2006-04-13 17:20:27 +08003845
3846#ifdef CONFIG_IPW2200_PROMISCUOUS
3847 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
3848 priv->sys_config.accept_all_data_frames = 1;
3849 priv->sys_config.accept_non_directed_frames = 1;
3850 priv->sys_config.accept_all_mgmt_bcpr = 1;
3851 priv->sys_config.accept_all_mgmt_frames = 1;
3852 }
3853#endif
3854
3855 ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06003856}
3857
3858struct ipw_status_code {
3859 u16 status;
3860 const char *reason;
3861};
3862
3863static const struct ipw_status_code ipw_status_codes[] = {
3864 {0x00, "Successful"},
3865 {0x01, "Unspecified failure"},
3866 {0x0A, "Cannot support all requested capabilities in the "
3867 "Capability information field"},
3868 {0x0B, "Reassociation denied due to inability to confirm that "
3869 "association exists"},
3870 {0x0C, "Association denied due to reason outside the scope of this "
3871 "standard"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003872 {0x0D,
3873 "Responding station does not support the specified authentication "
James Ketrenos43f66a62005-03-25 12:31:53 -06003874 "algorithm"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003875 {0x0E,
3876 "Received an Authentication frame with authentication sequence "
James Ketrenos43f66a62005-03-25 12:31:53 -06003877 "transaction sequence number out of expected sequence"},
3878 {0x0F, "Authentication rejected because of challenge failure"},
3879 {0x10, "Authentication rejected due to timeout waiting for next "
3880 "frame in sequence"},
3881 {0x11, "Association denied because AP is unable to handle additional "
3882 "associated stations"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003883 {0x12,
3884 "Association denied due to requesting station not supporting all "
James Ketrenos43f66a62005-03-25 12:31:53 -06003885 "of the datarates in the BSSBasicServiceSet Parameter"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003886 {0x13,
3887 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003888 "short preamble operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003889 {0x14,
3890 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003891 "PBCC encoding"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003892 {0x15,
3893 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003894 "channel agility"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003895 {0x19,
3896 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003897 "short slot operation"},
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003898 {0x1A,
3899 "Association denied due to requesting station not supporting "
James Ketrenos43f66a62005-03-25 12:31:53 -06003900 "DSSS-OFDM operation"},
3901 {0x28, "Invalid Information Element"},
3902 {0x29, "Group Cipher is not valid"},
3903 {0x2A, "Pairwise Cipher is not valid"},
3904 {0x2B, "AKMP is not valid"},
3905 {0x2C, "Unsupported RSN IE version"},
3906 {0x2D, "Invalid RSN IE Capabilities"},
3907 {0x2E, "Cipher suite is rejected per security policy"},
3908};
3909
Jeff Garzikbf794512005-07-31 13:07:26 -04003910static const char *ipw_get_status_code(u16 status)
James Ketrenos43f66a62005-03-25 12:31:53 -06003911{
3912 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -04003913 for (i = 0; i < ARRAY_SIZE(ipw_status_codes); i++)
James Ketrenosea2b26e2005-08-24 21:25:16 -05003914 if (ipw_status_codes[i].status == (status & 0xff))
James Ketrenos43f66a62005-03-25 12:31:53 -06003915 return ipw_status_codes[i].reason;
3916 return "Unknown status value.";
3917}
James Ketrenos43f66a62005-03-25 12:31:53 -06003918
3919static void inline average_init(struct average *avg)
3920{
3921 memset(avg, 0, sizeof(*avg));
3922}
3923
Zhu Yi00d21de2006-04-13 17:19:02 +08003924#define DEPTH_RSSI 8
3925#define DEPTH_NOISE 16
3926static s16 exponential_average(s16 prev_avg, s16 val, u8 depth)
3927{
3928 return ((depth-1)*prev_avg + val)/depth;
3929}
3930
Arjan van de Ven858119e2006-01-14 13:20:43 -08003931static void average_add(struct average *avg, s16 val)
James Ketrenos43f66a62005-03-25 12:31:53 -06003932{
3933 avg->sum -= avg->entries[avg->pos];
3934 avg->sum += val;
3935 avg->entries[avg->pos++] = val;
3936 if (unlikely(avg->pos == AVG_ENTRIES)) {
3937 avg->init = 1;
3938 avg->pos = 0;
3939 }
3940}
3941
Arjan van de Ven858119e2006-01-14 13:20:43 -08003942static s16 average_value(struct average *avg)
James Ketrenos43f66a62005-03-25 12:31:53 -06003943{
3944 if (!unlikely(avg->init)) {
3945 if (avg->pos)
3946 return avg->sum / avg->pos;
3947 return 0;
3948 }
3949
3950 return avg->sum / AVG_ENTRIES;
3951}
3952
3953static void ipw_reset_stats(struct ipw_priv *priv)
3954{
3955 u32 len = sizeof(u32);
3956
3957 priv->quality = 0;
3958
3959 average_init(&priv->average_missed_beacons);
Zhu Yi00d21de2006-04-13 17:19:02 +08003960 priv->exp_avg_rssi = -60;
3961 priv->exp_avg_noise = -85 + 0x100;
James Ketrenos43f66a62005-03-25 12:31:53 -06003962
3963 priv->last_rate = 0;
3964 priv->last_missed_beacons = 0;
3965 priv->last_rx_packets = 0;
3966 priv->last_tx_packets = 0;
3967 priv->last_tx_failures = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04003968
James Ketrenos43f66a62005-03-25 12:31:53 -06003969 /* Firmware managed, reset only when NIC is restarted, so we have to
3970 * normalize on the current value */
Jeff Garzikbf794512005-07-31 13:07:26 -04003971 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC,
James Ketrenos43f66a62005-03-25 12:31:53 -06003972 &priv->last_rx_err, &len);
Jeff Garzikbf794512005-07-31 13:07:26 -04003973 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE,
James Ketrenos43f66a62005-03-25 12:31:53 -06003974 &priv->last_tx_failures, &len);
3975
3976 /* Driver managed, reset with each association */
3977 priv->missed_adhoc_beacons = 0;
3978 priv->missed_beacons = 0;
3979 priv->tx_packets = 0;
3980 priv->rx_packets = 0;
3981
3982}
3983
Arjan van de Ven858119e2006-01-14 13:20:43 -08003984static u32 ipw_get_max_rate(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -06003985{
3986 u32 i = 0x80000000;
3987 u32 mask = priv->rates_mask;
3988 /* If currently associated in B mode, restrict the maximum
3989 * rate match to B rates */
3990 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
3991 mask &= IEEE80211_CCK_RATES_MASK;
3992
3993 /* TODO: Verify that the rate is supported by the current rates
3994 * list. */
3995
Jeff Garzik0edd5b42005-09-07 00:48:31 -04003996 while (i && !(mask & i))
3997 i >>= 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06003998 switch (i) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05003999 case IEEE80211_CCK_RATE_1MB_MASK:
4000 return 1000000;
4001 case IEEE80211_CCK_RATE_2MB_MASK:
4002 return 2000000;
4003 case IEEE80211_CCK_RATE_5MB_MASK:
4004 return 5500000;
4005 case IEEE80211_OFDM_RATE_6MB_MASK:
4006 return 6000000;
4007 case IEEE80211_OFDM_RATE_9MB_MASK:
4008 return 9000000;
4009 case IEEE80211_CCK_RATE_11MB_MASK:
4010 return 11000000;
4011 case IEEE80211_OFDM_RATE_12MB_MASK:
4012 return 12000000;
4013 case IEEE80211_OFDM_RATE_18MB_MASK:
4014 return 18000000;
4015 case IEEE80211_OFDM_RATE_24MB_MASK:
4016 return 24000000;
4017 case IEEE80211_OFDM_RATE_36MB_MASK:
4018 return 36000000;
4019 case IEEE80211_OFDM_RATE_48MB_MASK:
4020 return 48000000;
4021 case IEEE80211_OFDM_RATE_54MB_MASK:
4022 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004023 }
4024
Jeff Garzikbf794512005-07-31 13:07:26 -04004025 if (priv->ieee->mode == IEEE_B)
James Ketrenos43f66a62005-03-25 12:31:53 -06004026 return 11000000;
4027 else
4028 return 54000000;
4029}
4030
4031static u32 ipw_get_current_rate(struct ipw_priv *priv)
4032{
4033 u32 rate, len = sizeof(rate);
4034 int err;
4035
Jeff Garzikbf794512005-07-31 13:07:26 -04004036 if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06004037 return 0;
4038
4039 if (priv->tx_packets > IPW_REAL_RATE_RX_PACKET_THRESHOLD) {
Jeff Garzikbf794512005-07-31 13:07:26 -04004040 err = ipw_get_ordinal(priv, IPW_ORD_STAT_TX_CURR_RATE, &rate,
James Ketrenos43f66a62005-03-25 12:31:53 -06004041 &len);
4042 if (err) {
4043 IPW_DEBUG_INFO("failed querying ordinals.\n");
4044 return 0;
4045 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004046 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06004047 return ipw_get_max_rate(priv);
4048
4049 switch (rate) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004050 case IPW_TX_RATE_1MB:
4051 return 1000000;
4052 case IPW_TX_RATE_2MB:
4053 return 2000000;
4054 case IPW_TX_RATE_5MB:
4055 return 5500000;
4056 case IPW_TX_RATE_6MB:
4057 return 6000000;
4058 case IPW_TX_RATE_9MB:
4059 return 9000000;
4060 case IPW_TX_RATE_11MB:
4061 return 11000000;
4062 case IPW_TX_RATE_12MB:
4063 return 12000000;
4064 case IPW_TX_RATE_18MB:
4065 return 18000000;
4066 case IPW_TX_RATE_24MB:
4067 return 24000000;
4068 case IPW_TX_RATE_36MB:
4069 return 36000000;
4070 case IPW_TX_RATE_48MB:
4071 return 48000000;
4072 case IPW_TX_RATE_54MB:
4073 return 54000000;
James Ketrenos43f66a62005-03-25 12:31:53 -06004074 }
4075
4076 return 0;
4077}
4078
James Ketrenos43f66a62005-03-25 12:31:53 -06004079#define IPW_STATS_INTERVAL (2 * HZ)
4080static void ipw_gather_stats(struct ipw_priv *priv)
4081{
4082 u32 rx_err, rx_err_delta, rx_packets_delta;
4083 u32 tx_failures, tx_failures_delta, tx_packets_delta;
4084 u32 missed_beacons_percent, missed_beacons_delta;
4085 u32 quality = 0;
4086 u32 len = sizeof(u32);
4087 s16 rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04004088 u32 beacon_quality, signal_quality, tx_quality, rx_quality,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004089 rate_quality;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004090 u32 max_rate;
James Ketrenos43f66a62005-03-25 12:31:53 -06004091
4092 if (!(priv->status & STATUS_ASSOCIATED)) {
4093 priv->quality = 0;
4094 return;
4095 }
4096
4097 /* Update the statistics */
Jeff Garzikbf794512005-07-31 13:07:26 -04004098 ipw_get_ordinal(priv, IPW_ORD_STAT_MISSED_BEACONS,
James Ketrenos43f66a62005-03-25 12:31:53 -06004099 &priv->missed_beacons, &len);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004100 missed_beacons_delta = priv->missed_beacons - priv->last_missed_beacons;
James Ketrenos43f66a62005-03-25 12:31:53 -06004101 priv->last_missed_beacons = priv->missed_beacons;
4102 if (priv->assoc_request.beacon_interval) {
4103 missed_beacons_percent = missed_beacons_delta *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004104 (HZ * priv->assoc_request.beacon_interval) /
4105 (IPW_STATS_INTERVAL * 10);
James Ketrenos43f66a62005-03-25 12:31:53 -06004106 } else {
4107 missed_beacons_percent = 0;
4108 }
4109 average_add(&priv->average_missed_beacons, missed_beacons_percent);
4110
4111 ipw_get_ordinal(priv, IPW_ORD_STAT_RX_ERR_CRC, &rx_err, &len);
4112 rx_err_delta = rx_err - priv->last_rx_err;
4113 priv->last_rx_err = rx_err;
4114
4115 ipw_get_ordinal(priv, IPW_ORD_STAT_TX_FAILURE, &tx_failures, &len);
4116 tx_failures_delta = tx_failures - priv->last_tx_failures;
4117 priv->last_tx_failures = tx_failures;
4118
4119 rx_packets_delta = priv->rx_packets - priv->last_rx_packets;
4120 priv->last_rx_packets = priv->rx_packets;
4121
4122 tx_packets_delta = priv->tx_packets - priv->last_tx_packets;
4123 priv->last_tx_packets = priv->tx_packets;
4124
4125 /* Calculate quality based on the following:
Jeff Garzikbf794512005-07-31 13:07:26 -04004126 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004127 * Missed beacon: 100% = 0, 0% = 70% missed
4128 * Rate: 60% = 1Mbs, 100% = Max
4129 * Rx and Tx errors represent a straight % of total Rx/Tx
4130 * RSSI: 100% = > -50, 0% = < -80
4131 * Rx errors: 100% = 0, 0% = 50% missed
Jeff Garzikbf794512005-07-31 13:07:26 -04004132 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004133 * The lowest computed quality is used.
4134 *
4135 */
4136#define BEACON_THRESHOLD 5
4137 beacon_quality = 100 - missed_beacons_percent;
4138 if (beacon_quality < BEACON_THRESHOLD)
4139 beacon_quality = 0;
4140 else
Jeff Garzikbf794512005-07-31 13:07:26 -04004141 beacon_quality = (beacon_quality - BEACON_THRESHOLD) * 100 /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004142 (100 - BEACON_THRESHOLD);
Jeff Garzikbf794512005-07-31 13:07:26 -04004143 IPW_DEBUG_STATS("Missed beacon: %3d%% (%d%%)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004144 beacon_quality, missed_beacons_percent);
Jeff Garzikbf794512005-07-31 13:07:26 -04004145
James Ketrenos43f66a62005-03-25 12:31:53 -06004146 priv->last_rate = ipw_get_current_rate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004147 max_rate = ipw_get_max_rate(priv);
4148 rate_quality = priv->last_rate * 40 / max_rate + 60;
James Ketrenos43f66a62005-03-25 12:31:53 -06004149 IPW_DEBUG_STATS("Rate quality : %3d%% (%dMbs)\n",
4150 rate_quality, priv->last_rate / 1000000);
Jeff Garzikbf794512005-07-31 13:07:26 -04004151
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004152 if (rx_packets_delta > 100 && rx_packets_delta + rx_err_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004153 rx_quality = 100 - (rx_err_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004154 (rx_packets_delta + rx_err_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004155 else
4156 rx_quality = 100;
4157 IPW_DEBUG_STATS("Rx quality : %3d%% (%u errors, %u packets)\n",
4158 rx_quality, rx_err_delta, rx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004159
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004160 if (tx_packets_delta > 100 && tx_packets_delta + tx_failures_delta)
Jeff Garzikbf794512005-07-31 13:07:26 -04004161 tx_quality = 100 - (tx_failures_delta * 100) /
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004162 (tx_packets_delta + tx_failures_delta);
James Ketrenos43f66a62005-03-25 12:31:53 -06004163 else
4164 tx_quality = 100;
4165 IPW_DEBUG_STATS("Tx quality : %3d%% (%u errors, %u packets)\n",
4166 tx_quality, tx_failures_delta, tx_packets_delta);
Jeff Garzikbf794512005-07-31 13:07:26 -04004167
Zhu Yi00d21de2006-04-13 17:19:02 +08004168 rssi = priv->exp_avg_rssi;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004169 signal_quality =
4170 (100 *
4171 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4172 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) -
4173 (priv->ieee->perfect_rssi - rssi) *
4174 (15 * (priv->ieee->perfect_rssi - priv->ieee->worst_rssi) +
4175 62 * (priv->ieee->perfect_rssi - rssi))) /
4176 ((priv->ieee->perfect_rssi - priv->ieee->worst_rssi) *
4177 (priv->ieee->perfect_rssi - priv->ieee->worst_rssi));
4178 if (signal_quality > 100)
James Ketrenos43f66a62005-03-25 12:31:53 -06004179 signal_quality = 100;
James Ketrenosc848d0a2005-08-24 21:56:24 -05004180 else if (signal_quality < 1)
James Ketrenos43f66a62005-03-25 12:31:53 -06004181 signal_quality = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05004182
Zhu Yi61fb9ed2006-04-13 17:19:55 +08004183 IPW_DEBUG_STATS("Signal level : %3d%% (%d dBm)\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06004184 signal_quality, rssi);
Jeff Garzikbf794512005-07-31 13:07:26 -04004185
4186 quality = min(beacon_quality,
James Ketrenos43f66a62005-03-25 12:31:53 -06004187 min(rate_quality,
4188 min(tx_quality, min(rx_quality, signal_quality))));
4189 if (quality == beacon_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004190 IPW_DEBUG_STATS("Quality (%d%%): Clamped to missed beacons.\n",
4191 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004192 if (quality == rate_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004193 IPW_DEBUG_STATS("Quality (%d%%): Clamped to rate quality.\n",
4194 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004195 if (quality == tx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004196 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Tx quality.\n",
4197 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004198 if (quality == rx_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004199 IPW_DEBUG_STATS("Quality (%d%%): Clamped to Rx quality.\n",
4200 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004201 if (quality == signal_quality)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004202 IPW_DEBUG_STATS("Quality (%d%%): Clamped to signal quality.\n",
4203 quality);
James Ketrenos43f66a62005-03-25 12:31:53 -06004204
4205 priv->quality = quality;
Jeff Garzikbf794512005-07-31 13:07:26 -04004206
4207 queue_delayed_work(priv->workqueue, &priv->gather_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06004208 IPW_STATS_INTERVAL);
4209}
4210
James Ketrenosc848d0a2005-08-24 21:56:24 -05004211static void ipw_bg_gather_stats(void *data)
4212{
4213 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08004214 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004215 ipw_gather_stats(data);
Zhu Yi46441512006-01-24 16:37:59 +08004216 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05004217}
4218
Ben Cahille7582562005-10-06 15:34:41 -05004219/* Missed beacon behavior:
4220 * 1st missed -> roaming_threshold, just wait, don't do any scan/roam.
4221 * roaming_threshold -> disassociate_threshold, scan and roam for better signal.
4222 * Above disassociate threshold, give up and stop scanning.
4223 * Roaming is disabled if disassociate_threshold <= roaming_threshold */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004224static void ipw_handle_missed_beacon(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004225 int missed_count)
4226{
4227 priv->notif_missed_beacons = missed_count;
4228
James Ketrenosafbf30a2005-08-25 00:05:33 -05004229 if (missed_count > priv->disassociate_threshold &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05004230 priv->status & STATUS_ASSOCIATED) {
4231 /* If associated and we've hit the missed
4232 * beacon threshold, disassociate, turn
4233 * off roaming, and abort any active scans */
4234 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
James Ketrenosafbf30a2005-08-25 00:05:33 -05004235 IPW_DL_STATE | IPW_DL_ASSOC,
James Ketrenosea2b26e2005-08-24 21:25:16 -05004236 "Missed beacon: %d - disassociate\n", missed_count);
4237 priv->status &= ~STATUS_ROAMING;
James Ketrenosa613bff2005-08-24 21:43:11 -05004238 if (priv->status & STATUS_SCANNING) {
4239 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
4240 IPW_DL_STATE,
4241 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004242 queue_work(priv->workqueue, &priv->abort_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004243 }
4244
James Ketrenosea2b26e2005-08-24 21:25:16 -05004245 queue_work(priv->workqueue, &priv->disassociate);
4246 return;
4247 }
4248
4249 if (priv->status & STATUS_ROAMING) {
4250 /* If we are currently roaming, then just
4251 * print a debug statement... */
4252 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4253 "Missed beacon: %d - roam in progress\n",
4254 missed_count);
4255 return;
4256 }
4257
Zhu Yi4bfdb912006-01-24 16:37:16 +08004258 if (roaming &&
4259 (missed_count > priv->roaming_threshold &&
4260 missed_count <= priv->disassociate_threshold)) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05004261 /* If we are not already roaming, set the ROAM
Ben Cahille7582562005-10-06 15:34:41 -05004262 * bit in the status and kick off a scan.
4263 * This can happen several times before we reach
4264 * disassociate_threshold. */
James Ketrenosea2b26e2005-08-24 21:25:16 -05004265 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4266 "Missed beacon: %d - initiate "
4267 "roaming\n", missed_count);
4268 if (!(priv->status & STATUS_ROAMING)) {
4269 priv->status |= STATUS_ROAMING;
4270 if (!(priv->status & STATUS_SCANNING))
4271 queue_work(priv->workqueue,
4272 &priv->request_scan);
4273 }
4274 return;
4275 }
4276
4277 if (priv->status & STATUS_SCANNING) {
4278 /* Stop scan to keep fw from getting
4279 * stuck (only if we aren't roaming --
4280 * otherwise we'll never scan more than 2 or 3
4281 * channels..) */
James Ketrenosb095c382005-08-24 22:04:42 -05004282 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF | IPW_DL_STATE,
4283 "Aborting scan with missed beacon.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05004284 queue_work(priv->workqueue, &priv->abort_scan);
4285 }
4286
4287 IPW_DEBUG_NOTIF("Missed beacon: %d\n", missed_count);
James Ketrenosea2b26e2005-08-24 21:25:16 -05004288}
4289
James Ketrenos43f66a62005-03-25 12:31:53 -06004290/**
4291 * Handle host notification packet.
4292 * Called from interrupt routine
4293 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08004294static void ipw_rx_notification(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004295 struct ipw_rx_notification *notif)
4296{
James Ketrenosa613bff2005-08-24 21:43:11 -05004297 notif->size = le16_to_cpu(notif->size);
4298
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004299 IPW_DEBUG_NOTIF("type = %i (%d bytes)\n", notif->subtype, notif->size);
Jeff Garzikbf794512005-07-31 13:07:26 -04004300
James Ketrenos43f66a62005-03-25 12:31:53 -06004301 switch (notif->subtype) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004302 case HOST_NOTIFICATION_STATUS_ASSOCIATED:{
4303 struct notif_association *assoc = &notif->u.assoc;
Jeff Garzikbf794512005-07-31 13:07:26 -04004304
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004305 switch (assoc->state) {
4306 case CMAS_ASSOCIATED:{
4307 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4308 IPW_DL_ASSOC,
4309 "associated: '%s' " MAC_FMT
4310 " \n",
4311 escape_essid(priv->essid,
4312 priv->essid_len),
4313 MAC_ARG(priv->bssid));
Jeff Garzikbf794512005-07-31 13:07:26 -04004314
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004315 switch (priv->ieee->iw_mode) {
4316 case IW_MODE_INFRA:
4317 memcpy(priv->ieee->bssid,
4318 priv->bssid, ETH_ALEN);
4319 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004320
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004321 case IW_MODE_ADHOC:
4322 memcpy(priv->ieee->bssid,
4323 priv->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04004324
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004325 /* clear out the station table */
4326 priv->num_stations = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06004327
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004328 IPW_DEBUG_ASSOC
4329 ("queueing adhoc check\n");
4330 queue_delayed_work(priv->
4331 workqueue,
4332 &priv->
4333 adhoc_check,
4334 priv->
4335 assoc_request.
4336 beacon_interval);
4337 break;
4338 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004339
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004340 priv->status &= ~STATUS_ASSOCIATING;
4341 priv->status |= STATUS_ASSOCIATED;
Zhu Yid8bad6d2005-07-13 12:25:38 -05004342 queue_work(priv->workqueue,
4343 &priv->system_config);
James Ketrenos43f66a62005-03-25 12:31:53 -06004344
Zhu Yie43e3c12006-04-13 17:20:45 +08004345#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05004346#define IPW_GET_PACKET_STYPE(x) WLAN_FC_GET_STYPE( \
4347 le16_to_cpu(((struct ieee80211_hdr *)(x))->frame_ctl))
4348 if ((priv->status & STATUS_AUTH) &&
4349 (IPW_GET_PACKET_STYPE(&notif->u.raw)
4350 == IEEE80211_STYPE_ASSOC_RESP)) {
James Ketrenosb095c382005-08-24 22:04:42 -05004351 if ((sizeof
4352 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004353 ieee80211_assoc_response)
James Ketrenosb095c382005-08-24 22:04:42 -05004354 <= notif->size)
4355 && (notif->size <= 2314)) {
4356 struct
4357 ieee80211_rx_stats
4358 stats = {
4359 .len =
4360 notif->
4361 size - 1,
4362 };
4363
4364 IPW_DEBUG_QOS
4365 ("QoS Associate "
4366 "size %d\n",
4367 notif->size);
4368 ieee80211_rx_mgt(priv->
4369 ieee,
4370 (struct
James Ketrenos2b184d52005-08-03 20:33:14 -05004371 ieee80211_hdr_4addr
James Ketrenosb095c382005-08-24 22:04:42 -05004372 *)
4373 &notif->u.raw, &stats);
4374 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004375 }
James Ketrenosb095c382005-08-24 22:04:42 -05004376#endif
James Ketrenos43f66a62005-03-25 12:31:53 -06004377
James Ketrenosa613bff2005-08-24 21:43:11 -05004378 schedule_work(&priv->link_up);
James Ketrenos43f66a62005-03-25 12:31:53 -06004379
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004380 break;
4381 }
4382
4383 case CMAS_AUTHENTICATED:{
4384 if (priv->
4385 status & (STATUS_ASSOCIATED |
4386 STATUS_AUTH)) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004387 struct notif_authenticate *auth
4388 = &notif->u.auth;
4389 IPW_DEBUG(IPW_DL_NOTIF |
4390 IPW_DL_STATE |
4391 IPW_DL_ASSOC,
4392 "deauthenticated: '%s' "
4393 MAC_FMT
4394 ": (0x%04X) - %s \n",
4395 escape_essid(priv->
4396 essid,
4397 priv->
4398 essid_len),
4399 MAC_ARG(priv->bssid),
4400 ntohs(auth->status),
4401 ipw_get_status_code
4402 (ntohs
4403 (auth->status)));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004404
4405 priv->status &=
4406 ~(STATUS_ASSOCIATING |
4407 STATUS_AUTH |
4408 STATUS_ASSOCIATED);
4409
James Ketrenosa613bff2005-08-24 21:43:11 -05004410 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004411 break;
4412 }
4413
4414 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4415 IPW_DL_ASSOC,
4416 "authenticated: '%s' " MAC_FMT
4417 "\n",
4418 escape_essid(priv->essid,
4419 priv->essid_len),
4420 MAC_ARG(priv->bssid));
4421 break;
4422 }
4423
4424 case CMAS_INIT:{
James Ketrenosea2b26e2005-08-24 21:25:16 -05004425 if (priv->status & STATUS_AUTH) {
4426 struct
4427 ieee80211_assoc_response
4428 *resp;
4429 resp =
4430 (struct
4431 ieee80211_assoc_response
4432 *)&notif->u.raw;
4433 IPW_DEBUG(IPW_DL_NOTIF |
4434 IPW_DL_STATE |
4435 IPW_DL_ASSOC,
4436 "association failed (0x%04X): %s\n",
4437 ntohs(resp->status),
4438 ipw_get_status_code
4439 (ntohs
4440 (resp->status)));
4441 }
4442
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004443 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4444 IPW_DL_ASSOC,
4445 "disassociated: '%s' " MAC_FMT
4446 " \n",
4447 escape_essid(priv->essid,
4448 priv->essid_len),
4449 MAC_ARG(priv->bssid));
4450
4451 priv->status &=
4452 ~(STATUS_DISASSOCIATING |
4453 STATUS_ASSOCIATING |
4454 STATUS_ASSOCIATED | STATUS_AUTH);
James Ketrenosb095c382005-08-24 22:04:42 -05004455 if (priv->assoc_network
4456 && (priv->assoc_network->
4457 capability &
4458 WLAN_CAPABILITY_IBSS))
4459 ipw_remove_current_network
4460 (priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004461
James Ketrenosa613bff2005-08-24 21:43:11 -05004462 schedule_work(&priv->link_down);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004463
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004464 break;
4465 }
4466
James Ketrenosb095c382005-08-24 22:04:42 -05004467 case CMAS_RX_ASSOC_RESP:
4468 break;
4469
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004470 default:
4471 IPW_ERROR("assoc: unknown (%d)\n",
4472 assoc->state);
4473 break;
4474 }
4475
James Ketrenos43f66a62005-03-25 12:31:53 -06004476 break;
4477 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004478
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004479 case HOST_NOTIFICATION_STATUS_AUTHENTICATE:{
4480 struct notif_authenticate *auth = &notif->u.auth;
4481 switch (auth->state) {
4482 case CMAS_AUTHENTICATED:
4483 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
4484 "authenticated: '%s' " MAC_FMT " \n",
4485 escape_essid(priv->essid,
4486 priv->essid_len),
4487 MAC_ARG(priv->bssid));
4488 priv->status |= STATUS_AUTH;
4489 break;
4490
4491 case CMAS_INIT:
4492 if (priv->status & STATUS_AUTH) {
4493 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4494 IPW_DL_ASSOC,
4495 "authentication failed (0x%04X): %s\n",
4496 ntohs(auth->status),
4497 ipw_get_status_code(ntohs
4498 (auth->
4499 status)));
4500 }
4501 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4502 IPW_DL_ASSOC,
4503 "deauthenticated: '%s' " MAC_FMT "\n",
4504 escape_essid(priv->essid,
4505 priv->essid_len),
4506 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06004507
4508 priv->status &= ~(STATUS_ASSOCIATING |
4509 STATUS_AUTH |
4510 STATUS_ASSOCIATED);
4511
James Ketrenosa613bff2005-08-24 21:43:11 -05004512 schedule_work(&priv->link_down);
James Ketrenos43f66a62005-03-25 12:31:53 -06004513 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004514
4515 case CMAS_TX_AUTH_SEQ_1:
4516 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4517 IPW_DL_ASSOC, "AUTH_SEQ_1\n");
4518 break;
4519 case CMAS_RX_AUTH_SEQ_2:
4520 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4521 IPW_DL_ASSOC, "AUTH_SEQ_2\n");
4522 break;
4523 case CMAS_AUTH_SEQ_1_PASS:
4524 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4525 IPW_DL_ASSOC, "AUTH_SEQ_1_PASS\n");
4526 break;
4527 case CMAS_AUTH_SEQ_1_FAIL:
4528 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4529 IPW_DL_ASSOC, "AUTH_SEQ_1_FAIL\n");
4530 break;
4531 case CMAS_TX_AUTH_SEQ_3:
4532 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4533 IPW_DL_ASSOC, "AUTH_SEQ_3\n");
4534 break;
4535 case CMAS_RX_AUTH_SEQ_4:
4536 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4537 IPW_DL_ASSOC, "RX_AUTH_SEQ_4\n");
4538 break;
4539 case CMAS_AUTH_SEQ_2_PASS:
4540 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4541 IPW_DL_ASSOC, "AUTH_SEQ_2_PASS\n");
4542 break;
4543 case CMAS_AUTH_SEQ_2_FAIL:
4544 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4545 IPW_DL_ASSOC, "AUT_SEQ_2_FAIL\n");
4546 break;
4547 case CMAS_TX_ASSOC:
4548 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4549 IPW_DL_ASSOC, "TX_ASSOC\n");
4550 break;
4551 case CMAS_RX_ASSOC_RESP:
4552 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4553 IPW_DL_ASSOC, "RX_ASSOC_RESP\n");
James Ketrenosb095c382005-08-24 22:04:42 -05004554
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004555 break;
4556 case CMAS_ASSOCIATED:
4557 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE |
4558 IPW_DL_ASSOC, "ASSOCIATED\n");
4559 break;
4560 default:
4561 IPW_DEBUG_NOTIF("auth: failure - %d\n",
4562 auth->state);
4563 break;
4564 }
4565 break;
4566 }
4567
4568 case HOST_NOTIFICATION_STATUS_SCAN_CHANNEL_RESULT:{
4569 struct notif_channel_result *x =
4570 &notif->u.channel_result;
4571
4572 if (notif->size == sizeof(*x)) {
4573 IPW_DEBUG_SCAN("Scan result for channel %d\n",
4574 x->channel_num);
4575 } else {
4576 IPW_DEBUG_SCAN("Scan result of wrong size %d "
4577 "(should be %zd)\n",
4578 notif->size, sizeof(*x));
4579 }
4580 break;
4581 }
4582
4583 case HOST_NOTIFICATION_STATUS_SCAN_COMPLETED:{
4584 struct notif_scan_complete *x = &notif->u.scan_complete;
4585 if (notif->size == sizeof(*x)) {
4586 IPW_DEBUG_SCAN
4587 ("Scan completed: type %d, %d channels, "
4588 "%d status\n", x->scan_type,
4589 x->num_channels, x->status);
4590 } else {
4591 IPW_ERROR("Scan completed of wrong size %d "
4592 "(should be %zd)\n",
4593 notif->size, sizeof(*x));
4594 }
4595
4596 priv->status &=
4597 ~(STATUS_SCANNING | STATUS_SCAN_ABORTING);
4598
James Ketrenosa0e04ab2005-08-25 00:49:43 -05004599 wake_up_interruptible(&priv->wait_state);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004600 cancel_delayed_work(&priv->scan_check);
4601
James Ketrenosb095c382005-08-24 22:04:42 -05004602 if (priv->status & STATUS_EXIT_PENDING)
4603 break;
4604
4605 priv->ieee->scans++;
4606
4607#ifdef CONFIG_IPW2200_MONITOR
4608 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05004609 priv->status |= STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004610 queue_work(priv->workqueue,
4611 &priv->request_scan);
4612 break;
4613 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05004614 priv->status &= ~STATUS_SCAN_FORCED;
James Ketrenosb095c382005-08-24 22:04:42 -05004615#endif /* CONFIG_IPW2200_MONITOR */
4616
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004617 if (!(priv->status & (STATUS_ASSOCIATED |
4618 STATUS_ASSOCIATING |
4619 STATUS_ROAMING |
4620 STATUS_DISASSOCIATING)))
4621 queue_work(priv->workqueue, &priv->associate);
4622 else if (priv->status & STATUS_ROAMING) {
Ben Cahille7582562005-10-06 15:34:41 -05004623 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE)
4624 /* If a scan completed and we are in roam mode, then
4625 * the scan that completed was the one requested as a
4626 * result of entering roam... so, schedule the
4627 * roam work */
4628 queue_work(priv->workqueue,
4629 &priv->roam);
4630 else
4631 /* Don't schedule if we aborted the scan */
4632 priv->status &= ~STATUS_ROAMING;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004633 } else if (priv->status & STATUS_SCAN_PENDING)
4634 queue_work(priv->workqueue,
4635 &priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -05004636 else if (priv->config & CFG_BACKGROUND_SCAN
4637 && priv->status & STATUS_ASSOCIATED)
4638 queue_delayed_work(priv->workqueue,
4639 &priv->request_scan, HZ);
Zhu Yi07f02e42006-04-13 17:19:25 +08004640
4641 /* Send an empty event to user space.
4642 * We don't send the received data on the event because
4643 * it would require us to do complex transcoding, and
4644 * we want to minimise the work done in the irq handler
4645 * Use a request to extract the data.
4646 * Also, we generate this even for any scan, regardless
4647 * on how the scan was initiated. User space can just
4648 * sync on periodic scan to get fresh data...
4649 * Jean II */
4650 if (x->status == SCAN_COMPLETED_STATUS_COMPLETE) {
4651 union iwreq_data wrqu;
4652
4653 wrqu.data.length = 0;
4654 wrqu.data.flags = 0;
4655 wireless_send_event(priv->net_dev, SIOCGIWSCAN,
4656 &wrqu, NULL);
4657 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004658 break;
4659 }
4660
4661 case HOST_NOTIFICATION_STATUS_FRAG_LENGTH:{
4662 struct notif_frag_length *x = &notif->u.frag_len;
4663
James Ketrenosa613bff2005-08-24 21:43:11 -05004664 if (notif->size == sizeof(*x))
4665 IPW_ERROR("Frag length: %d\n",
4666 le16_to_cpu(x->frag_length));
4667 else
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004668 IPW_ERROR("Frag length of wrong size %d "
4669 "(should be %zd)\n",
4670 notif->size, sizeof(*x));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004671 break;
4672 }
4673
4674 case HOST_NOTIFICATION_STATUS_LINK_DETERIORATION:{
4675 struct notif_link_deterioration *x =
4676 &notif->u.link_deterioration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05004677
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004678 if (notif->size == sizeof(*x)) {
4679 IPW_DEBUG(IPW_DL_NOTIF | IPW_DL_STATE,
Cahill, Ben M12977152006-03-08 02:58:02 +08004680 "link deterioration: type %d, cnt %d\n",
4681 x->silence_notification_type,
4682 x->silence_count);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004683 memcpy(&priv->last_link_deterioration, x,
4684 sizeof(*x));
4685 } else {
4686 IPW_ERROR("Link Deterioration of wrong size %d "
4687 "(should be %zd)\n",
4688 notif->size, sizeof(*x));
4689 }
4690 break;
4691 }
4692
4693 case HOST_NOTIFICATION_DINO_CONFIG_RESPONSE:{
4694 IPW_ERROR("Dino config\n");
4695 if (priv->hcmd
James Ketrenosa613bff2005-08-24 21:43:11 -05004696 && priv->hcmd->cmd != HOST_CMD_DINO_CONFIG)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004697 IPW_ERROR("Unexpected DINO_CONFIG_RESPONSE\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05004698
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004699 break;
4700 }
4701
4702 case HOST_NOTIFICATION_STATUS_BEACON_STATE:{
4703 struct notif_beacon_state *x = &notif->u.beacon_state;
4704 if (notif->size != sizeof(*x)) {
4705 IPW_ERROR
4706 ("Beacon state of wrong size %d (should "
4707 "be %zd)\n", notif->size, sizeof(*x));
4708 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004709 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004710
James Ketrenosa613bff2005-08-24 21:43:11 -05004711 if (le32_to_cpu(x->state) ==
4712 HOST_NOTIFICATION_STATUS_BEACON_MISSING)
4713 ipw_handle_missed_beacon(priv,
4714 le32_to_cpu(x->
4715 number));
Jeff Garzikbf794512005-07-31 13:07:26 -04004716
James Ketrenos43f66a62005-03-25 12:31:53 -06004717 break;
4718 }
Jeff Garzikbf794512005-07-31 13:07:26 -04004719
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004720 case HOST_NOTIFICATION_STATUS_TGI_TX_KEY:{
4721 struct notif_tgi_tx_key *x = &notif->u.tgi_tx_key;
4722 if (notif->size == sizeof(*x)) {
4723 IPW_ERROR("TGi Tx Key: state 0x%02x sec type "
4724 "0x%02x station %d\n",
4725 x->key_state, x->security_type,
4726 x->station_index);
4727 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004728 }
4729
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004730 IPW_ERROR
4731 ("TGi Tx Key of wrong size %d (should be %zd)\n",
4732 notif->size, sizeof(*x));
4733 break;
4734 }
4735
4736 case HOST_NOTIFICATION_CALIB_KEEP_RESULTS:{
4737 struct notif_calibration *x = &notif->u.calibration;
4738
4739 if (notif->size == sizeof(*x)) {
4740 memcpy(&priv->calib, x, sizeof(*x));
4741 IPW_DEBUG_INFO("TODO: Calibration\n");
4742 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06004743 }
4744
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004745 IPW_ERROR
4746 ("Calibration of wrong size %d (should be %zd)\n",
4747 notif->size, sizeof(*x));
James Ketrenos43f66a62005-03-25 12:31:53 -06004748 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004749 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004750
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004751 case HOST_NOTIFICATION_NOISE_STATS:{
4752 if (notif->size == sizeof(u32)) {
Zhu Yi00d21de2006-04-13 17:19:02 +08004753 priv->exp_avg_noise =
4754 exponential_average(priv->exp_avg_noise,
4755 (u8) (le32_to_cpu(notif->u.noise.value) & 0xff),
4756 DEPTH_NOISE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004757 break;
4758 }
James Ketrenos43f66a62005-03-25 12:31:53 -06004759
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004760 IPW_ERROR
4761 ("Noise stat is wrong size %d (should be %zd)\n",
4762 notif->size, sizeof(u32));
James Ketrenos43f66a62005-03-25 12:31:53 -06004763 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04004764 }
4765
James Ketrenos43f66a62005-03-25 12:31:53 -06004766 default:
Zhu Yi1dd31b62006-02-20 18:28:09 -08004767 IPW_DEBUG_NOTIF("Unknown notification: "
4768 "subtype=%d,flags=0x%2x,size=%d\n",
4769 notif->subtype, notif->flags, notif->size);
James Ketrenos43f66a62005-03-25 12:31:53 -06004770 }
4771}
4772
4773/**
4774 * Destroys all DMA structures and initialise them again
Jeff Garzikbf794512005-07-31 13:07:26 -04004775 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004776 * @param priv
4777 * @return error code
4778 */
4779static int ipw_queue_reset(struct ipw_priv *priv)
4780{
4781 int rc = 0;
4782 /** @todo customize queue sizes */
4783 int nTx = 64, nTxCmd = 8;
4784 ipw_tx_queue_free(priv);
4785 /* Tx CMD queue */
4786 rc = ipw_queue_tx_init(priv, &priv->txq_cmd, nTxCmd,
James Ketrenosb095c382005-08-24 22:04:42 -05004787 IPW_TX_CMD_QUEUE_READ_INDEX,
4788 IPW_TX_CMD_QUEUE_WRITE_INDEX,
4789 IPW_TX_CMD_QUEUE_BD_BASE,
4790 IPW_TX_CMD_QUEUE_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004791 if (rc) {
4792 IPW_ERROR("Tx Cmd queue init failed\n");
4793 goto error;
4794 }
4795 /* Tx queue(s) */
4796 rc = ipw_queue_tx_init(priv, &priv->txq[0], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004797 IPW_TX_QUEUE_0_READ_INDEX,
4798 IPW_TX_QUEUE_0_WRITE_INDEX,
4799 IPW_TX_QUEUE_0_BD_BASE, IPW_TX_QUEUE_0_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004800 if (rc) {
4801 IPW_ERROR("Tx 0 queue init failed\n");
4802 goto error;
4803 }
4804 rc = ipw_queue_tx_init(priv, &priv->txq[1], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004805 IPW_TX_QUEUE_1_READ_INDEX,
4806 IPW_TX_QUEUE_1_WRITE_INDEX,
4807 IPW_TX_QUEUE_1_BD_BASE, IPW_TX_QUEUE_1_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004808 if (rc) {
4809 IPW_ERROR("Tx 1 queue init failed\n");
4810 goto error;
4811 }
4812 rc = ipw_queue_tx_init(priv, &priv->txq[2], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004813 IPW_TX_QUEUE_2_READ_INDEX,
4814 IPW_TX_QUEUE_2_WRITE_INDEX,
4815 IPW_TX_QUEUE_2_BD_BASE, IPW_TX_QUEUE_2_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004816 if (rc) {
4817 IPW_ERROR("Tx 2 queue init failed\n");
4818 goto error;
4819 }
4820 rc = ipw_queue_tx_init(priv, &priv->txq[3], nTx,
James Ketrenosb095c382005-08-24 22:04:42 -05004821 IPW_TX_QUEUE_3_READ_INDEX,
4822 IPW_TX_QUEUE_3_WRITE_INDEX,
4823 IPW_TX_QUEUE_3_BD_BASE, IPW_TX_QUEUE_3_BD_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06004824 if (rc) {
4825 IPW_ERROR("Tx 3 queue init failed\n");
4826 goto error;
4827 }
4828 /* statistics */
4829 priv->rx_bufs_min = 0;
4830 priv->rx_pend_max = 0;
4831 return rc;
4832
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004833 error:
James Ketrenos43f66a62005-03-25 12:31:53 -06004834 ipw_tx_queue_free(priv);
4835 return rc;
4836}
4837
4838/**
4839 * Reclaim Tx queue entries no more used by NIC.
Jeff Garzikbf794512005-07-31 13:07:26 -04004840 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004841 * When FW adwances 'R' index, all entries between old and
4842 * new 'R' index need to be reclaimed. As result, some free space
4843 * forms. If there is enough free space (> low mark), wake Tx queue.
Jeff Garzikbf794512005-07-31 13:07:26 -04004844 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004845 * @note Need to protect against garbage in 'R' index
4846 * @param priv
4847 * @param txq
4848 * @param qindex
4849 * @return Number of used entries remains in the queue
4850 */
Jeff Garzikbf794512005-07-31 13:07:26 -04004851static int ipw_queue_tx_reclaim(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06004852 struct clx2_tx_queue *txq, int qindex)
4853{
4854 u32 hw_tail;
4855 int used;
4856 struct clx2_queue *q = &txq->q;
4857
4858 hw_tail = ipw_read32(priv, q->reg_r);
4859 if (hw_tail >= q->n_bd) {
4860 IPW_ERROR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004861 ("Read index for DMA queue (%d) is out of range [0-%d)\n",
4862 hw_tail, q->n_bd);
James Ketrenos43f66a62005-03-25 12:31:53 -06004863 goto done;
4864 }
4865 for (; q->last_used != hw_tail;
4866 q->last_used = ipw_queue_inc_wrap(q->last_used, q->n_bd)) {
4867 ipw_queue_tx_free_tfd(priv, txq);
4868 priv->tx_packets++;
4869 }
Jeff Garzik0edd5b42005-09-07 00:48:31 -04004870 done:
James Ketrenos9ddf84f2005-08-16 17:07:11 -05004871 if ((ipw_queue_space(q) > q->low_mark) &&
4872 (qindex >= 0) &&
4873 (priv->status & STATUS_ASSOCIATED) && netif_running(priv->net_dev))
4874 netif_wake_queue(priv->net_dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06004875 used = q->first_empty - q->last_used;
4876 if (used < 0)
4877 used += q->n_bd;
4878
4879 return used;
4880}
4881
4882static int ipw_queue_tx_hcmd(struct ipw_priv *priv, int hcmd, void *buf,
4883 int len, int sync)
4884{
4885 struct clx2_tx_queue *txq = &priv->txq_cmd;
4886 struct clx2_queue *q = &txq->q;
4887 struct tfd_frame *tfd;
4888
4889 if (ipw_queue_space(q) < (sync ? 1 : 2)) {
4890 IPW_ERROR("No space for Tx\n");
4891 return -EBUSY;
4892 }
4893
4894 tfd = &txq->bd[q->first_empty];
4895 txq->txb[q->first_empty] = NULL;
4896
4897 memset(tfd, 0, sizeof(*tfd));
4898 tfd->control_flags.message_type = TX_HOST_COMMAND_TYPE;
4899 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
4900 priv->hcmd_seq++;
4901 tfd->u.cmd.index = hcmd;
4902 tfd->u.cmd.length = len;
4903 memcpy(tfd->u.cmd.payload, buf, len);
4904 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
4905 ipw_write32(priv, q->reg_w, q->first_empty);
4906 _ipw_read32(priv, 0x90);
4907
4908 return 0;
4909}
4910
Jeff Garzikbf794512005-07-31 13:07:26 -04004911/*
James Ketrenos43f66a62005-03-25 12:31:53 -06004912 * Rx theory of operation
4913 *
4914 * The host allocates 32 DMA target addresses and passes the host address
James Ketrenosb095c382005-08-24 22:04:42 -05004915 * to the firmware at register IPW_RFDS_TABLE_LOWER + N * RFD_SIZE where N is
James Ketrenos43f66a62005-03-25 12:31:53 -06004916 * 0 to 31
4917 *
4918 * Rx Queue Indexes
4919 * The host/firmware share two index registers for managing the Rx buffers.
4920 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004921 * The READ index maps to the first position that the firmware may be writing
4922 * to -- the driver can read up to (but not including) this position and get
4923 * good data.
James Ketrenos43f66a62005-03-25 12:31:53 -06004924 * The READ index is managed by the firmware once the card is enabled.
4925 *
4926 * The WRITE index maps to the last position the driver has read from -- the
4927 * position preceding WRITE is the last slot the firmware can place a packet.
4928 *
4929 * The queue is empty (no good data) if WRITE = READ - 1, and is full if
Jeff Garzikbf794512005-07-31 13:07:26 -04004930 * WRITE = READ.
James Ketrenos43f66a62005-03-25 12:31:53 -06004931 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004932 * During initialization the host sets up the READ queue position to the first
James Ketrenos43f66a62005-03-25 12:31:53 -06004933 * INDEX position, and WRITE to the last (READ - 1 wrapped)
4934 *
4935 * When the firmware places a packet in a buffer it will advance the READ index
4936 * and fire the RX interrupt. The driver can then query the READ index and
4937 * process as many packets as possible, moving the WRITE index forward as it
4938 * resets the Rx queue buffers with new memory.
Jeff Garzikbf794512005-07-31 13:07:26 -04004939 *
James Ketrenos43f66a62005-03-25 12:31:53 -06004940 * The management in the driver is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04004941 * + A list of pre-allocated SKBs is stored in ipw->rxq->rx_free. When
James Ketrenos43f66a62005-03-25 12:31:53 -06004942 * ipw->rxq->free_count drops to or below RX_LOW_WATERMARK, work is scheduled
Jeff Garzikbf794512005-07-31 13:07:26 -04004943 * to replensish the ipw->rxq->rx_free.
James Ketrenos43f66a62005-03-25 12:31:53 -06004944 * + In ipw_rx_queue_replenish (scheduled) if 'processed' != 'read' then the
4945 * ipw->rxq is replenished and the READ INDEX is updated (updating the
4946 * 'processed' and 'read' driver indexes as well)
4947 * + A received packet is processed and handed to the kernel network stack,
4948 * detached from the ipw->rxq. The driver 'processed' index is updated.
4949 * + The Host/Firmware ipw->rxq is replenished at tasklet time from the rx_free
Jeff Garzikbf794512005-07-31 13:07:26 -04004950 * list. If there are no allocated buffers in ipw->rxq->rx_free, the READ
4951 * INDEX is not incremented and ipw->status(RX_STALLED) is set. If there
James Ketrenos43f66a62005-03-25 12:31:53 -06004952 * were enough free buffers and RX_STALLED is set it is cleared.
4953 *
4954 *
4955 * Driver sequence:
4956 *
Jeff Garzikbf794512005-07-31 13:07:26 -04004957 * ipw_rx_queue_alloc() Allocates rx_free
James Ketrenos43f66a62005-03-25 12:31:53 -06004958 * ipw_rx_queue_replenish() Replenishes rx_free list from rx_used, and calls
4959 * ipw_rx_queue_restock
4960 * ipw_rx_queue_restock() Moves available buffers from rx_free into Rx
4961 * queue, updates firmware pointers, and updates
4962 * the WRITE index. If insufficient rx_free buffers
4963 * are available, schedules ipw_rx_queue_replenish
4964 *
4965 * -- enable interrupts --
4966 * ISR - ipw_rx() Detach ipw_rx_mem_buffers from pool up to the
Jeff Garzikbf794512005-07-31 13:07:26 -04004967 * READ INDEX, detaching the SKB from the pool.
James Ketrenos43f66a62005-03-25 12:31:53 -06004968 * Moves the packet buffer from queue to rx_used.
4969 * Calls ipw_rx_queue_restock to refill any empty
4970 * slots.
4971 * ...
4972 *
4973 */
4974
Jeff Garzikbf794512005-07-31 13:07:26 -04004975/*
James Ketrenos43f66a62005-03-25 12:31:53 -06004976 * If there are slots in the RX queue that need to be restocked,
4977 * and we have free pre-allocated buffers, fill the ranks as much
4978 * as we can pulling from rx_free.
4979 *
4980 * This moves the 'write' index forward to catch up with 'processed', and
4981 * also updates the memory address in the firmware to reference the new
4982 * target buffer.
4983 */
4984static void ipw_rx_queue_restock(struct ipw_priv *priv)
4985{
4986 struct ipw_rx_queue *rxq = priv->rxq;
4987 struct list_head *element;
4988 struct ipw_rx_mem_buffer *rxb;
4989 unsigned long flags;
4990 int write;
4991
4992 spin_lock_irqsave(&rxq->lock, flags);
4993 write = rxq->write;
4994 while ((rxq->write != rxq->processed) && (rxq->free_count)) {
4995 element = rxq->rx_free.next;
4996 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
4997 list_del(element);
4998
James Ketrenosb095c382005-08-24 22:04:42 -05004999 ipw_write32(priv, IPW_RFDS_TABLE_LOWER + rxq->write * RFD_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06005000 rxb->dma_addr);
5001 rxq->queue[rxq->write] = rxb;
5002 rxq->write = (rxq->write + 1) % RX_QUEUE_SIZE;
5003 rxq->free_count--;
5004 }
5005 spin_unlock_irqrestore(&rxq->lock, flags);
5006
Jeff Garzikbf794512005-07-31 13:07:26 -04005007 /* If the pre-allocated buffer pool is dropping low, schedule to
James Ketrenos43f66a62005-03-25 12:31:53 -06005008 * refill it */
5009 if (rxq->free_count <= RX_LOW_WATERMARK)
5010 queue_work(priv->workqueue, &priv->rx_replenish);
5011
5012 /* If we've added more space for the firmware to place data, tell it */
Jeff Garzikbf794512005-07-31 13:07:26 -04005013 if (write != rxq->write)
James Ketrenosb095c382005-08-24 22:04:42 -05005014 ipw_write32(priv, IPW_RX_WRITE_INDEX, rxq->write);
James Ketrenos43f66a62005-03-25 12:31:53 -06005015}
5016
5017/*
5018 * Move all used packet from rx_used to rx_free, allocating a new SKB for each.
Jeff Garzikbf794512005-07-31 13:07:26 -04005019 * Also restock the Rx queue via ipw_rx_queue_restock.
5020 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005021 * This is called as a scheduled work item (except for during intialization)
5022 */
5023static void ipw_rx_queue_replenish(void *data)
5024{
5025 struct ipw_priv *priv = data;
5026 struct ipw_rx_queue *rxq = priv->rxq;
5027 struct list_head *element;
5028 struct ipw_rx_mem_buffer *rxb;
5029 unsigned long flags;
5030
5031 spin_lock_irqsave(&rxq->lock, flags);
5032 while (!list_empty(&rxq->rx_used)) {
5033 element = rxq->rx_used.next;
5034 rxb = list_entry(element, struct ipw_rx_mem_buffer, list);
James Ketrenosb095c382005-08-24 22:04:42 -05005035 rxb->skb = alloc_skb(IPW_RX_BUF_SIZE, GFP_ATOMIC);
James Ketrenos43f66a62005-03-25 12:31:53 -06005036 if (!rxb->skb) {
5037 printk(KERN_CRIT "%s: Can not allocate SKB buffers.\n",
5038 priv->net_dev->name);
5039 /* We don't reschedule replenish work here -- we will
5040 * call the restock method and if it still needs
5041 * more buffers it will schedule replenish */
5042 break;
5043 }
5044 list_del(element);
Jeff Garzikbf794512005-07-31 13:07:26 -04005045
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005046 rxb->dma_addr =
5047 pci_map_single(priv->pci_dev, rxb->skb->data,
James Ketrenosb095c382005-08-24 22:04:42 -05005048 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
Jeff Garzikbf794512005-07-31 13:07:26 -04005049
James Ketrenos43f66a62005-03-25 12:31:53 -06005050 list_add_tail(&rxb->list, &rxq->rx_free);
5051 rxq->free_count++;
5052 }
5053 spin_unlock_irqrestore(&rxq->lock, flags);
5054
5055 ipw_rx_queue_restock(priv);
5056}
5057
James Ketrenosc848d0a2005-08-24 21:56:24 -05005058static void ipw_bg_rx_queue_replenish(void *data)
5059{
5060 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08005061 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005062 ipw_rx_queue_replenish(data);
Zhu Yi46441512006-01-24 16:37:59 +08005063 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005064}
5065
James Ketrenos43f66a62005-03-25 12:31:53 -06005066/* Assumes that the skb field of the buffers in 'pool' is kept accurate.
Zhu Yic7b6a672006-01-24 16:37:05 +08005067 * If an SKB has been detached, the POOL needs to have its SKB set to NULL
Jeff Garzikbf794512005-07-31 13:07:26 -04005068 * This free routine walks the list of POOL entries and if SKB is set to
James Ketrenos43f66a62005-03-25 12:31:53 -06005069 * non NULL it is unmapped and freed
5070 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005071static void ipw_rx_queue_free(struct ipw_priv *priv, struct ipw_rx_queue *rxq)
James Ketrenos43f66a62005-03-25 12:31:53 -06005072{
5073 int i;
5074
5075 if (!rxq)
5076 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04005077
James Ketrenos43f66a62005-03-25 12:31:53 -06005078 for (i = 0; i < RX_QUEUE_SIZE + RX_FREE_BUFFERS; i++) {
5079 if (rxq->pool[i].skb != NULL) {
5080 pci_unmap_single(priv->pci_dev, rxq->pool[i].dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05005081 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06005082 dev_kfree_skb(rxq->pool[i].skb);
5083 }
5084 }
5085
5086 kfree(rxq);
5087}
5088
5089static struct ipw_rx_queue *ipw_rx_queue_alloc(struct ipw_priv *priv)
5090{
5091 struct ipw_rx_queue *rxq;
5092 int i;
5093
Takisc75f4742005-12-01 01:41:45 -08005094 rxq = kzalloc(sizeof(*rxq), GFP_KERNEL);
Panagiotis Issarisad18b0e2005-09-05 04:14:10 +02005095 if (unlikely(!rxq)) {
5096 IPW_ERROR("memory allocation failed\n");
5097 return NULL;
5098 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005099 spin_lock_init(&rxq->lock);
5100 INIT_LIST_HEAD(&rxq->rx_free);
5101 INIT_LIST_HEAD(&rxq->rx_used);
5102
5103 /* Fill the rx_used queue with _all_ of the Rx buffers */
Jeff Garzikbf794512005-07-31 13:07:26 -04005104 for (i = 0; i < RX_FREE_BUFFERS + RX_QUEUE_SIZE; i++)
James Ketrenos43f66a62005-03-25 12:31:53 -06005105 list_add_tail(&rxq->pool[i].list, &rxq->rx_used);
5106
5107 /* Set us so that we have processed and used all buffers, but have
5108 * not restocked the Rx queue with fresh buffers */
5109 rxq->read = rxq->write = 0;
5110 rxq->processed = RX_QUEUE_SIZE - 1;
5111 rxq->free_count = 0;
5112
5113 return rxq;
5114}
5115
5116static int ipw_is_rate_in_mask(struct ipw_priv *priv, int ieee_mode, u8 rate)
5117{
5118 rate &= ~IEEE80211_BASIC_RATE_MASK;
5119 if (ieee_mode == IEEE_A) {
5120 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005121 case IEEE80211_OFDM_RATE_6MB:
5122 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005123 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005124 case IEEE80211_OFDM_RATE_9MB:
5125 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005126 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005127 case IEEE80211_OFDM_RATE_12MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005128 return priv->
5129 rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005130 case IEEE80211_OFDM_RATE_18MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005131 return priv->
5132 rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005133 case IEEE80211_OFDM_RATE_24MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005134 return priv->
5135 rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005136 case IEEE80211_OFDM_RATE_36MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005137 return priv->
5138 rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005139 case IEEE80211_OFDM_RATE_48MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005140 return priv->
5141 rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005142 case IEEE80211_OFDM_RATE_54MB:
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005143 return priv->
5144 rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005145 default:
5146 return 0;
5147 }
5148 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005149
James Ketrenos43f66a62005-03-25 12:31:53 -06005150 /* B and G mixed */
5151 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005152 case IEEE80211_CCK_RATE_1MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005153 return priv->rates_mask & IEEE80211_CCK_RATE_1MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005154 case IEEE80211_CCK_RATE_2MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005155 return priv->rates_mask & IEEE80211_CCK_RATE_2MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005156 case IEEE80211_CCK_RATE_5MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005157 return priv->rates_mask & IEEE80211_CCK_RATE_5MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005158 case IEEE80211_CCK_RATE_11MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005159 return priv->rates_mask & IEEE80211_CCK_RATE_11MB_MASK ? 1 : 0;
5160 }
5161
5162 /* If we are limited to B modulations, bail at this point */
5163 if (ieee_mode == IEEE_B)
5164 return 0;
5165
5166 /* G */
5167 switch (rate) {
Jeff Garzikbf794512005-07-31 13:07:26 -04005168 case IEEE80211_OFDM_RATE_6MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005169 return priv->rates_mask & IEEE80211_OFDM_RATE_6MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005170 case IEEE80211_OFDM_RATE_9MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005171 return priv->rates_mask & IEEE80211_OFDM_RATE_9MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005172 case IEEE80211_OFDM_RATE_12MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005173 return priv->rates_mask & IEEE80211_OFDM_RATE_12MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005174 case IEEE80211_OFDM_RATE_18MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005175 return priv->rates_mask & IEEE80211_OFDM_RATE_18MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005176 case IEEE80211_OFDM_RATE_24MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005177 return priv->rates_mask & IEEE80211_OFDM_RATE_24MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005178 case IEEE80211_OFDM_RATE_36MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005179 return priv->rates_mask & IEEE80211_OFDM_RATE_36MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005180 case IEEE80211_OFDM_RATE_48MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005181 return priv->rates_mask & IEEE80211_OFDM_RATE_48MB_MASK ? 1 : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005182 case IEEE80211_OFDM_RATE_54MB:
James Ketrenos43f66a62005-03-25 12:31:53 -06005183 return priv->rates_mask & IEEE80211_OFDM_RATE_54MB_MASK ? 1 : 0;
5184 }
5185
5186 return 0;
5187}
5188
Jeff Garzikbf794512005-07-31 13:07:26 -04005189static int ipw_compatible_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -06005190 const struct ieee80211_network *network,
5191 struct ipw_supported_rates *rates)
5192{
5193 int num_rates, i;
5194
5195 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005196 num_rates = min(network->rates_len, (u8) IPW_MAX_RATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06005197 rates->num_rates = 0;
5198 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005199 if (!ipw_is_rate_in_mask(priv, network->mode,
5200 network->rates[i])) {
5201
James Ketrenosea2b26e2005-08-24 21:25:16 -05005202 if (network->rates[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005203 IPW_DEBUG_SCAN("Adding masked mandatory "
5204 "rate %02X\n",
5205 network->rates[i]);
5206 rates->supported_rates[rates->num_rates++] =
5207 network->rates[i];
5208 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005209 }
5210
James Ketrenos43f66a62005-03-25 12:31:53 -06005211 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5212 network->rates[i], priv->rates_mask);
5213 continue;
5214 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005215
James Ketrenos43f66a62005-03-25 12:31:53 -06005216 rates->supported_rates[rates->num_rates++] = network->rates[i];
5217 }
5218
James Ketrenosa613bff2005-08-24 21:43:11 -05005219 num_rates = min(network->rates_ex_len,
5220 (u8) (IPW_MAX_RATES - num_rates));
James Ketrenos43f66a62005-03-25 12:31:53 -06005221 for (i = 0; i < num_rates; i++) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005222 if (!ipw_is_rate_in_mask(priv, network->mode,
5223 network->rates_ex[i])) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05005224 if (network->rates_ex[i] & IEEE80211_BASIC_RATE_MASK) {
James Ketrenosa613bff2005-08-24 21:43:11 -05005225 IPW_DEBUG_SCAN("Adding masked mandatory "
5226 "rate %02X\n",
5227 network->rates_ex[i]);
5228 rates->supported_rates[rates->num_rates++] =
5229 network->rates[i];
5230 continue;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005231 }
5232
James Ketrenos43f66a62005-03-25 12:31:53 -06005233 IPW_DEBUG_SCAN("Rate %02X masked : 0x%08X\n",
5234 network->rates_ex[i], priv->rates_mask);
5235 continue;
5236 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005237
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005238 rates->supported_rates[rates->num_rates++] =
5239 network->rates_ex[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06005240 }
5241
James Ketrenosea2b26e2005-08-24 21:25:16 -05005242 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06005243}
5244
Arjan van de Ven858119e2006-01-14 13:20:43 -08005245static void ipw_copy_rates(struct ipw_supported_rates *dest,
James Ketrenos43f66a62005-03-25 12:31:53 -06005246 const struct ipw_supported_rates *src)
5247{
5248 u8 i;
5249 for (i = 0; i < src->num_rates; i++)
5250 dest->supported_rates[i] = src->supported_rates[i];
5251 dest->num_rates = src->num_rates;
5252}
5253
5254/* TODO: Look at sniffed packets in the air to determine if the basic rate
5255 * mask should ever be used -- right now all callers to add the scan rates are
5256 * set with the modulation = CCK, so BASIC_RATE_MASK is never set... */
5257static void ipw_add_cck_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005258 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005259{
Jeff Garzikbf794512005-07-31 13:07:26 -04005260 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005261 IEEE80211_BASIC_RATE_MASK : 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005262
James Ketrenos43f66a62005-03-25 12:31:53 -06005263 if (rate_mask & IEEE80211_CCK_RATE_1MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005264 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005265 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005266
5267 if (rate_mask & IEEE80211_CCK_RATE_2MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005268 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005269 IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005270
5271 if (rate_mask & IEEE80211_CCK_RATE_5MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005272 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005273 IEEE80211_CCK_RATE_5MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005274
5275 if (rate_mask & IEEE80211_CCK_RATE_11MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005276 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005277 IEEE80211_CCK_RATE_11MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005278}
5279
5280static void ipw_add_ofdm_scan_rates(struct ipw_supported_rates *rates,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005281 u8 modulation, u32 rate_mask)
James Ketrenos43f66a62005-03-25 12:31:53 -06005282{
Jeff Garzikbf794512005-07-31 13:07:26 -04005283 u8 basic_mask = (IEEE80211_OFDM_MODULATION == modulation) ?
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005284 IEEE80211_BASIC_RATE_MASK : 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005285
5286 if (rate_mask & IEEE80211_OFDM_RATE_6MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005287 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005288 IEEE80211_OFDM_RATE_6MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005289
5290 if (rate_mask & IEEE80211_OFDM_RATE_9MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005291 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005292 IEEE80211_OFDM_RATE_9MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005293
5294 if (rate_mask & IEEE80211_OFDM_RATE_12MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005295 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005296 IEEE80211_OFDM_RATE_12MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005297
5298 if (rate_mask & IEEE80211_OFDM_RATE_18MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005299 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005300 IEEE80211_OFDM_RATE_18MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005301
5302 if (rate_mask & IEEE80211_OFDM_RATE_24MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005303 rates->supported_rates[rates->num_rates++] = basic_mask |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005304 IEEE80211_OFDM_RATE_24MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005305
5306 if (rate_mask & IEEE80211_OFDM_RATE_36MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005307 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005308 IEEE80211_OFDM_RATE_36MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005309
5310 if (rate_mask & IEEE80211_OFDM_RATE_48MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005311 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005312 IEEE80211_OFDM_RATE_48MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005313
5314 if (rate_mask & IEEE80211_OFDM_RATE_54MB_MASK)
Jeff Garzikbf794512005-07-31 13:07:26 -04005315 rates->supported_rates[rates->num_rates++] =
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005316 IEEE80211_OFDM_RATE_54MB;
James Ketrenos43f66a62005-03-25 12:31:53 -06005317}
5318
5319struct ipw_network_match {
5320 struct ieee80211_network *network;
5321 struct ipw_supported_rates rates;
5322};
5323
James Ketrenosc848d0a2005-08-24 21:56:24 -05005324static int ipw_find_adhoc_network(struct ipw_priv *priv,
5325 struct ipw_network_match *match,
5326 struct ieee80211_network *network,
5327 int roaming)
5328{
5329 struct ipw_supported_rates rates;
5330
5331 /* Verify that this network's capability is compatible with the
5332 * current mode (AdHoc or Infrastructure) */
5333 if ((priv->ieee->iw_mode == IW_MODE_ADHOC &&
5334 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5335 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded due to "
5336 "capability mismatch.\n",
5337 escape_essid(network->ssid, network->ssid_len),
5338 MAC_ARG(network->bssid));
5339 return 0;
5340 }
5341
5342 /* If we do not have an ESSID for this AP, we can not associate with
5343 * it */
5344 if (network->flags & NETWORK_EMPTY_ESSID) {
5345 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5346 "because of hidden ESSID.\n",
5347 escape_essid(network->ssid, network->ssid_len),
5348 MAC_ARG(network->bssid));
5349 return 0;
5350 }
5351
5352 if (unlikely(roaming)) {
5353 /* If we are roaming, then ensure check if this is a valid
5354 * network to try and roam to */
5355 if ((network->ssid_len != match->network->ssid_len) ||
5356 memcmp(network->ssid, match->network->ssid,
5357 network->ssid_len)) {
5358 IPW_DEBUG_MERGE("Netowrk '%s (" MAC_FMT ")' excluded "
5359 "because of non-network ESSID.\n",
5360 escape_essid(network->ssid,
5361 network->ssid_len),
5362 MAC_ARG(network->bssid));
5363 return 0;
5364 }
5365 } else {
5366 /* If an ESSID has been configured then compare the broadcast
5367 * ESSID to ours */
5368 if ((priv->config & CFG_STATIC_ESSID) &&
5369 ((network->ssid_len != priv->essid_len) ||
5370 memcmp(network->ssid, priv->essid,
5371 min(network->ssid_len, priv->essid_len)))) {
5372 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
James Ketrenosafbf30a2005-08-25 00:05:33 -05005373
James Ketrenosc848d0a2005-08-24 21:56:24 -05005374 strncpy(escaped,
5375 escape_essid(network->ssid, network->ssid_len),
5376 sizeof(escaped));
5377 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5378 "because of ESSID mismatch: '%s'.\n",
5379 escaped, MAC_ARG(network->bssid),
5380 escape_essid(priv->essid,
5381 priv->essid_len));
5382 return 0;
5383 }
5384 }
5385
5386 /* If the old network rate is better than this one, don't bother
5387 * testing everything else. */
5388
5389 if (network->time_stamp[0] < match->network->time_stamp[0]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005390 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5391 "current network.\n",
5392 escape_essid(match->network->ssid,
5393 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005394 return 0;
5395 } else if (network->time_stamp[1] < match->network->time_stamp[1]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005396 IPW_DEBUG_MERGE("Network '%s excluded because newer than "
5397 "current network.\n",
5398 escape_essid(match->network->ssid,
5399 match->network->ssid_len));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005400 return 0;
5401 }
5402
5403 /* Now go through and see if the requested network is valid... */
5404 if (priv->ieee->scan_age != 0 &&
5405 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
5406 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005407 "because of age: %ums.\n",
James Ketrenosc848d0a2005-08-24 21:56:24 -05005408 escape_essid(network->ssid, network->ssid_len),
5409 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005410 jiffies_to_msecs(jiffies -
5411 network->last_scanned));
James Ketrenosc848d0a2005-08-24 21:56:24 -05005412 return 0;
5413 }
5414
5415 if ((priv->config & CFG_STATIC_CHANNEL) &&
5416 (network->channel != priv->channel)) {
5417 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5418 "because of channel mismatch: %d != %d.\n",
5419 escape_essid(network->ssid, network->ssid_len),
5420 MAC_ARG(network->bssid),
5421 network->channel, priv->channel);
5422 return 0;
5423 }
5424
5425 /* Verify privacy compatability */
5426 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
5427 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5428 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5429 "because of privacy mismatch: %s != %s.\n",
5430 escape_essid(network->ssid, network->ssid_len),
5431 MAC_ARG(network->bssid),
James Ketrenosafbf30a2005-08-25 00:05:33 -05005432 priv->
5433 capability & CAP_PRIVACY_ON ? "on" : "off",
5434 network->
5435 capability & WLAN_CAPABILITY_PRIVACY ? "on" :
5436 "off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05005437 return 0;
5438 }
5439
5440 if (!memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5441 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5442 "because of the same BSSID match: " MAC_FMT
5443 ".\n", escape_essid(network->ssid,
5444 network->ssid_len),
5445 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
5446 return 0;
5447 }
5448
5449 /* Filter out any incompatible freq / mode combinations */
5450 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5451 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5452 "because of invalid frequency/mode "
5453 "combination.\n",
5454 escape_essid(network->ssid, network->ssid_len),
5455 MAC_ARG(network->bssid));
5456 return 0;
5457 }
5458
5459 /* Ensure that the rates supported by the driver are compatible with
5460 * this AP, including verification of basic rates (mandatory) */
5461 if (!ipw_compatible_rates(priv, network, &rates)) {
5462 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5463 "because configured rate mask excludes "
5464 "AP mandatory rate.\n",
5465 escape_essid(network->ssid, network->ssid_len),
5466 MAC_ARG(network->bssid));
5467 return 0;
5468 }
5469
5470 if (rates.num_rates == 0) {
5471 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' excluded "
5472 "because of no compatible rates.\n",
5473 escape_essid(network->ssid, network->ssid_len),
5474 MAC_ARG(network->bssid));
5475 return 0;
5476 }
5477
5478 /* TODO: Perform any further minimal comparititive tests. We do not
5479 * want to put too much policy logic here; intelligent scan selection
5480 * should occur within a generic IEEE 802.11 user space tool. */
5481
5482 /* Set up 'new' AP to this network */
5483 ipw_copy_rates(&match->rates, &rates);
5484 match->network = network;
5485 IPW_DEBUG_MERGE("Network '%s (" MAC_FMT ")' is a viable match.\n",
5486 escape_essid(network->ssid, network->ssid_len),
5487 MAC_ARG(network->bssid));
5488
5489 return 1;
5490}
5491
5492static void ipw_merge_adhoc_network(void *data)
5493{
5494 struct ipw_priv *priv = data;
5495 struct ieee80211_network *network = NULL;
5496 struct ipw_network_match match = {
5497 .network = priv->assoc_network
5498 };
5499
James Ketrenosafbf30a2005-08-25 00:05:33 -05005500 if ((priv->status & STATUS_ASSOCIATED) &&
5501 (priv->ieee->iw_mode == IW_MODE_ADHOC)) {
James Ketrenosc848d0a2005-08-24 21:56:24 -05005502 /* First pass through ROAM process -- look for a better
5503 * network */
5504 unsigned long flags;
5505
5506 spin_lock_irqsave(&priv->ieee->lock, flags);
5507 list_for_each_entry(network, &priv->ieee->network_list, list) {
5508 if (network != priv->assoc_network)
5509 ipw_find_adhoc_network(priv, &match, network,
5510 1);
5511 }
5512 spin_unlock_irqrestore(&priv->ieee->lock, flags);
5513
5514 if (match.network == priv->assoc_network) {
5515 IPW_DEBUG_MERGE("No better ADHOC in this network to "
5516 "merge to.\n");
5517 return;
5518 }
5519
Zhu Yi46441512006-01-24 16:37:59 +08005520 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005521 if ((priv->ieee->iw_mode == IW_MODE_ADHOC)) {
5522 IPW_DEBUG_MERGE("remove network %s\n",
5523 escape_essid(priv->essid,
5524 priv->essid_len));
5525 ipw_remove_current_network(priv);
5526 }
5527
5528 ipw_disassociate(priv);
5529 priv->assoc_network = match.network;
Zhu Yi46441512006-01-24 16:37:59 +08005530 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005531 return;
5532 }
James Ketrenosc848d0a2005-08-24 21:56:24 -05005533}
5534
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005535static int ipw_best_network(struct ipw_priv *priv,
5536 struct ipw_network_match *match,
5537 struct ieee80211_network *network, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06005538{
5539 struct ipw_supported_rates rates;
5540
5541 /* Verify that this network's capability is compatible with the
5542 * current mode (AdHoc or Infrastructure) */
5543 if ((priv->ieee->iw_mode == IW_MODE_INFRA &&
Jouni Malinen24743852005-08-14 20:59:59 -07005544 !(network->capability & WLAN_CAPABILITY_ESS)) ||
James Ketrenos43f66a62005-03-25 12:31:53 -06005545 (priv->ieee->iw_mode == IW_MODE_ADHOC &&
5546 !(network->capability & WLAN_CAPABILITY_IBSS))) {
5547 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded due to "
Jeff Garzikbf794512005-07-31 13:07:26 -04005548 "capability mismatch.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005549 escape_essid(network->ssid, network->ssid_len),
5550 MAC_ARG(network->bssid));
5551 return 0;
5552 }
5553
5554 /* If we do not have an ESSID for this AP, we can not associate with
5555 * it */
5556 if (network->flags & NETWORK_EMPTY_ESSID) {
5557 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5558 "because of hidden ESSID.\n",
5559 escape_essid(network->ssid, network->ssid_len),
5560 MAC_ARG(network->bssid));
5561 return 0;
5562 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005563
James Ketrenos43f66a62005-03-25 12:31:53 -06005564 if (unlikely(roaming)) {
5565 /* If we are roaming, then ensure check if this is a valid
5566 * network to try and roam to */
5567 if ((network->ssid_len != match->network->ssid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005568 memcmp(network->ssid, match->network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005569 network->ssid_len)) {
5570 IPW_DEBUG_ASSOC("Netowrk '%s (" MAC_FMT ")' excluded "
5571 "because of non-network ESSID.\n",
Jeff Garzikbf794512005-07-31 13:07:26 -04005572 escape_essid(network->ssid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005573 network->ssid_len),
5574 MAC_ARG(network->bssid));
5575 return 0;
5576 }
5577 } else {
Jeff Garzikbf794512005-07-31 13:07:26 -04005578 /* If an ESSID has been configured then compare the broadcast
5579 * ESSID to ours */
5580 if ((priv->config & CFG_STATIC_ESSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005581 ((network->ssid_len != priv->essid_len) ||
Jeff Garzikbf794512005-07-31 13:07:26 -04005582 memcmp(network->ssid, priv->essid,
James Ketrenos43f66a62005-03-25 12:31:53 -06005583 min(network->ssid_len, priv->essid_len)))) {
5584 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005585 strncpy(escaped,
5586 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005587 sizeof(escaped));
5588 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Jeff Garzikbf794512005-07-31 13:07:26 -04005589 "because of ESSID mismatch: '%s'.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005590 escaped, MAC_ARG(network->bssid),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005591 escape_essid(priv->essid,
5592 priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005593 return 0;
5594 }
5595 }
5596
5597 /* If the old network rate is better than this one, don't bother
5598 * testing everything else. */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005599 if (match->network && match->network->stats.rssi > network->stats.rssi) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005600 char escaped[IW_ESSID_MAX_SIZE * 2 + 1];
Jeff Garzikbf794512005-07-31 13:07:26 -04005601 strncpy(escaped,
5602 escape_essid(network->ssid, network->ssid_len),
James Ketrenos43f66a62005-03-25 12:31:53 -06005603 sizeof(escaped));
5604 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded because "
5605 "'%s (" MAC_FMT ")' has a stronger signal.\n",
5606 escaped, MAC_ARG(network->bssid),
5607 escape_essid(match->network->ssid,
5608 match->network->ssid_len),
5609 MAC_ARG(match->network->bssid));
5610 return 0;
5611 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005612
James Ketrenos43f66a62005-03-25 12:31:53 -06005613 /* If this network has already had an association attempt within the
5614 * last 3 seconds, do not try and associate again... */
5615 if (network->last_associate &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005616 time_after(network->last_associate + (HZ * 3UL), jiffies)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005617 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005618 "because of storming (%ums since last "
James Ketrenos43f66a62005-03-25 12:31:53 -06005619 "assoc attempt).\n",
5620 escape_essid(network->ssid, network->ssid_len),
5621 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005622 jiffies_to_msecs(jiffies -
5623 network->last_associate));
James Ketrenos43f66a62005-03-25 12:31:53 -06005624 return 0;
5625 }
5626
5627 /* Now go through and see if the requested network is valid... */
Jeff Garzikbf794512005-07-31 13:07:26 -04005628 if (priv->ieee->scan_age != 0 &&
James Ketrenosea2b26e2005-08-24 21:25:16 -05005629 time_after(jiffies, network->last_scanned + priv->ieee->scan_age)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06005630 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
Zhu Yic7b6a672006-01-24 16:37:05 +08005631 "because of age: %ums.\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06005632 escape_essid(network->ssid, network->ssid_len),
5633 MAC_ARG(network->bssid),
Zhu Yi2638bc32006-01-24 16:37:52 +08005634 jiffies_to_msecs(jiffies -
5635 network->last_scanned));
James Ketrenos43f66a62005-03-25 12:31:53 -06005636 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04005637 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005638
Jeff Garzikbf794512005-07-31 13:07:26 -04005639 if ((priv->config & CFG_STATIC_CHANNEL) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005640 (network->channel != priv->channel)) {
5641 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5642 "because of channel mismatch: %d != %d.\n",
5643 escape_essid(network->ssid, network->ssid_len),
5644 MAC_ARG(network->bssid),
5645 network->channel, priv->channel);
5646 return 0;
5647 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005648
James Ketrenos43f66a62005-03-25 12:31:53 -06005649 /* Verify privacy compatability */
Jeff Garzikbf794512005-07-31 13:07:26 -04005650 if (((priv->capability & CAP_PRIVACY_ON) ? 1 : 0) !=
James Ketrenos43f66a62005-03-25 12:31:53 -06005651 ((network->capability & WLAN_CAPABILITY_PRIVACY) ? 1 : 0)) {
5652 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5653 "because of privacy mismatch: %s != %s.\n",
5654 escape_essid(network->ssid, network->ssid_len),
5655 MAC_ARG(network->bssid),
Jeff Garzikbf794512005-07-31 13:07:26 -04005656 priv->capability & CAP_PRIVACY_ON ? "on" :
James Ketrenos43f66a62005-03-25 12:31:53 -06005657 "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04005658 network->capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005659 WLAN_CAPABILITY_PRIVACY ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06005660 return 0;
5661 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005662
5663 if ((priv->config & CFG_STATIC_BSSID) &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005664 memcmp(network->bssid, priv->bssid, ETH_ALEN)) {
5665 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5666 "because of BSSID mismatch: " MAC_FMT ".\n",
5667 escape_essid(network->ssid, network->ssid_len),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005668 MAC_ARG(network->bssid), MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005669 return 0;
5670 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005671
James Ketrenos43f66a62005-03-25 12:31:53 -06005672 /* Filter out any incompatible freq / mode combinations */
5673 if (!ieee80211_is_valid_mode(priv->ieee, network->mode)) {
5674 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5675 "because of invalid frequency/mode "
5676 "combination.\n",
5677 escape_essid(network->ssid, network->ssid_len),
5678 MAC_ARG(network->bssid));
5679 return 0;
5680 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005681
Liu Hong1fe0adb2005-08-19 09:33:10 -05005682 /* Filter out invalid channel in current GEO */
Larry Finger1867b112006-02-28 09:48:28 -06005683 if (!ieee80211_is_valid_channel(priv->ieee, network->channel)) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05005684 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5685 "because of invalid channel in current GEO\n",
5686 escape_essid(network->ssid, network->ssid_len),
5687 MAC_ARG(network->bssid));
5688 return 0;
5689 }
5690
James Ketrenosea2b26e2005-08-24 21:25:16 -05005691 /* Ensure that the rates supported by the driver are compatible with
5692 * this AP, including verification of basic rates (mandatory) */
5693 if (!ipw_compatible_rates(priv, network, &rates)) {
5694 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5695 "because configured rate mask excludes "
5696 "AP mandatory rate.\n",
5697 escape_essid(network->ssid, network->ssid_len),
5698 MAC_ARG(network->bssid));
5699 return 0;
5700 }
5701
James Ketrenos43f66a62005-03-25 12:31:53 -06005702 if (rates.num_rates == 0) {
5703 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' excluded "
5704 "because of no compatible rates.\n",
5705 escape_essid(network->ssid, network->ssid_len),
5706 MAC_ARG(network->bssid));
5707 return 0;
5708 }
Jeff Garzikbf794512005-07-31 13:07:26 -04005709
James Ketrenos43f66a62005-03-25 12:31:53 -06005710 /* TODO: Perform any further minimal comparititive tests. We do not
5711 * want to put too much policy logic here; intelligent scan selection
5712 * should occur within a generic IEEE 802.11 user space tool. */
5713
5714 /* Set up 'new' AP to this network */
5715 ipw_copy_rates(&match->rates, &rates);
5716 match->network = network;
5717
5718 IPW_DEBUG_ASSOC("Network '%s (" MAC_FMT ")' is a viable match.\n",
5719 escape_essid(network->ssid, network->ssid_len),
5720 MAC_ARG(network->bssid));
5721
5722 return 1;
5723}
5724
Jeff Garzikbf794512005-07-31 13:07:26 -04005725static void ipw_adhoc_create(struct ipw_priv *priv,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005726 struct ieee80211_network *network)
James Ketrenos43f66a62005-03-25 12:31:53 -06005727{
Larry Finger1867b112006-02-28 09:48:28 -06005728 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005729 int i;
5730
James Ketrenos43f66a62005-03-25 12:31:53 -06005731 /*
5732 * For the purposes of scanning, we can set our wireless mode
5733 * to trigger scans across combinations of bands, but when it
5734 * comes to creating a new ad-hoc network, we have tell the FW
5735 * exactly which band to use.
5736 *
Jeff Garzikbf794512005-07-31 13:07:26 -04005737 * We also have the possibility of an invalid channel for the
James Ketrenos43f66a62005-03-25 12:31:53 -06005738 * chossen band. Attempting to create a new ad-hoc network
5739 * with an invalid channel for wireless mode will trigger a
5740 * FW fatal error.
James Ketrenosafbf30a2005-08-25 00:05:33 -05005741 *
James Ketrenos43f66a62005-03-25 12:31:53 -06005742 */
Larry Finger1867b112006-02-28 09:48:28 -06005743 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005744 case IEEE80211_52GHZ_BAND:
5745 network->mode = IEEE_A;
Larry Finger1867b112006-02-28 09:48:28 -06005746 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005747 BUG_ON(i == -1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005748 if (geo->a[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5749 IPW_WARNING("Overriding invalid channel\n");
5750 priv->channel = geo->a[0].channel;
5751 }
5752 break;
5753
5754 case IEEE80211_24GHZ_BAND:
5755 if (priv->ieee->mode & IEEE_G)
5756 network->mode = IEEE_G;
5757 else
5758 network->mode = IEEE_B;
Larry Finger1867b112006-02-28 09:48:28 -06005759 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02005760 BUG_ON(i == -1);
Liu Hong1fe0adb2005-08-19 09:33:10 -05005761 if (geo->bg[i].flags & IEEE80211_CH_PASSIVE_ONLY) {
5762 IPW_WARNING("Overriding invalid channel\n");
5763 priv->channel = geo->bg[0].channel;
5764 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005765 break;
5766
5767 default:
James Ketrenos43f66a62005-03-25 12:31:53 -06005768 IPW_WARNING("Overriding invalid channel\n");
5769 if (priv->ieee->mode & IEEE_A) {
5770 network->mode = IEEE_A;
James Ketrenosb095c382005-08-24 22:04:42 -05005771 priv->channel = geo->a[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005772 } else if (priv->ieee->mode & IEEE_G) {
5773 network->mode = IEEE_G;
James Ketrenosb095c382005-08-24 22:04:42 -05005774 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005775 } else {
5776 network->mode = IEEE_B;
James Ketrenosb095c382005-08-24 22:04:42 -05005777 priv->channel = geo->bg[0].channel;
James Ketrenos43f66a62005-03-25 12:31:53 -06005778 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05005779 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005780 }
5781
5782 network->channel = priv->channel;
5783 priv->config |= CFG_ADHOC_PERSIST;
5784 ipw_create_bssid(priv, network->bssid);
5785 network->ssid_len = priv->essid_len;
5786 memcpy(network->ssid, priv->essid, priv->essid_len);
5787 memset(&network->stats, 0, sizeof(network->stats));
5788 network->capability = WLAN_CAPABILITY_IBSS;
James Ketrenosea2b26e2005-08-24 21:25:16 -05005789 if (!(priv->config & CFG_PREAMBLE_LONG))
5790 network->capability |= WLAN_CAPABILITY_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -06005791 if (priv->capability & CAP_PRIVACY_ON)
5792 network->capability |= WLAN_CAPABILITY_PRIVACY;
5793 network->rates_len = min(priv->rates.num_rates, MAX_RATES_LENGTH);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005794 memcpy(network->rates, priv->rates.supported_rates, network->rates_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06005795 network->rates_ex_len = priv->rates.num_rates - network->rates_len;
Jeff Garzikbf794512005-07-31 13:07:26 -04005796 memcpy(network->rates_ex,
James Ketrenos43f66a62005-03-25 12:31:53 -06005797 &priv->rates.supported_rates[network->rates_len],
5798 network->rates_ex_len);
5799 network->last_scanned = 0;
5800 network->flags = 0;
5801 network->last_associate = 0;
5802 network->time_stamp[0] = 0;
5803 network->time_stamp[1] = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005804 network->beacon_interval = 100; /* Default */
5805 network->listen_interval = 10; /* Default */
5806 network->atim_window = 0; /* Default */
James Ketrenos43f66a62005-03-25 12:31:53 -06005807 network->wpa_ie_len = 0;
5808 network->rsn_ie_len = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005809}
5810
James Ketrenosb095c382005-08-24 22:04:42 -05005811static void ipw_send_tgi_tx_key(struct ipw_priv *priv, int type, int index)
5812{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005813 struct ipw_tgi_tx_key key;
James Ketrenosb095c382005-08-24 22:04:42 -05005814
5815 if (!(priv->ieee->sec.flags & (1 << index)))
5816 return;
5817
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005818 key.key_id = index;
5819 memcpy(key.key, priv->ieee->sec.keys[index], SCM_TEMPORAL_KEY_LENGTH);
5820 key.security_type = type;
5821 key.station_index = 0; /* always 0 for BSS */
5822 key.flags = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005823 /* 0 for new key; previous value of counter (after fatal error) */
Zhu Yi851ca262006-08-21 11:37:58 +08005824 key.tx_counter[0] = cpu_to_le32(0);
5825 key.tx_counter[1] = cpu_to_le32(0);
James Ketrenosb095c382005-08-24 22:04:42 -05005826
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005827 ipw_send_cmd_pdu(priv, IPW_CMD_TGI_TX_KEY, sizeof(key), &key);
James Ketrenosb095c382005-08-24 22:04:42 -05005828}
5829
5830static void ipw_send_wep_keys(struct ipw_priv *priv, int type)
James Ketrenos43f66a62005-03-25 12:31:53 -06005831{
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005832 struct ipw_wep_key key;
James Ketrenos43f66a62005-03-25 12:31:53 -06005833 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -06005834
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005835 key.cmd_id = DINO_CMD_WEP_KEY;
5836 key.seq_num = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06005837
James Ketrenosb095c382005-08-24 22:04:42 -05005838 /* Note: AES keys cannot be set for multiple times.
5839 * Only set it at the first time. */
Jeff Garzikbf794512005-07-31 13:07:26 -04005840 for (i = 0; i < 4; i++) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005841 key.key_index = i | type;
James Ketrenosb095c382005-08-24 22:04:42 -05005842 if (!(priv->ieee->sec.flags & (1 << i))) {
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005843 key.key_size = 0;
James Ketrenosb095c382005-08-24 22:04:42 -05005844 continue;
James Ketrenos43f66a62005-03-25 12:31:53 -06005845 }
5846
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005847 key.key_size = priv->ieee->sec.key_sizes[i];
5848 memcpy(key.key, priv->ieee->sec.keys[i], key.key_size);
James Ketrenosb095c382005-08-24 22:04:42 -05005849
Zhu Yi0a7bcf22006-01-24 16:37:28 +08005850 ipw_send_cmd_pdu(priv, IPW_CMD_WEP_KEY, sizeof(key), &key);
Jeff Garzikbf794512005-07-31 13:07:26 -04005851 }
James Ketrenos43f66a62005-03-25 12:31:53 -06005852}
5853
Zhu Yi1fbfea52005-08-05 17:22:56 +08005854static void ipw_set_hw_decrypt_unicast(struct ipw_priv *priv, int level)
5855{
5856 if (priv->ieee->host_encrypt)
5857 return;
5858
5859 switch (level) {
5860 case SEC_LEVEL_3:
5861 priv->sys_config.disable_unicast_decryption = 0;
5862 priv->ieee->host_decrypt = 0;
5863 break;
5864 case SEC_LEVEL_2:
5865 priv->sys_config.disable_unicast_decryption = 1;
5866 priv->ieee->host_decrypt = 1;
5867 break;
5868 case SEC_LEVEL_1:
5869 priv->sys_config.disable_unicast_decryption = 0;
5870 priv->ieee->host_decrypt = 0;
5871 break;
5872 case SEC_LEVEL_0:
5873 priv->sys_config.disable_unicast_decryption = 1;
5874 break;
5875 default:
5876 break;
5877 }
5878}
5879
5880static void ipw_set_hw_decrypt_multicast(struct ipw_priv *priv, int level)
5881{
5882 if (priv->ieee->host_encrypt)
5883 return;
5884
5885 switch (level) {
5886 case SEC_LEVEL_3:
5887 priv->sys_config.disable_multicast_decryption = 0;
5888 break;
5889 case SEC_LEVEL_2:
5890 priv->sys_config.disable_multicast_decryption = 1;
5891 break;
5892 case SEC_LEVEL_1:
5893 priv->sys_config.disable_multicast_decryption = 0;
5894 break;
5895 case SEC_LEVEL_0:
5896 priv->sys_config.disable_multicast_decryption = 1;
5897 break;
5898 default:
5899 break;
5900 }
5901}
5902
James Ketrenosb095c382005-08-24 22:04:42 -05005903static void ipw_set_hwcrypto_keys(struct ipw_priv *priv)
5904{
5905 switch (priv->ieee->sec.level) {
5906 case SEC_LEVEL_3:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005907 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5908 ipw_send_tgi_tx_key(priv,
5909 DCT_FLAG_EXT_SECURITY_CCM,
5910 priv->ieee->sec.active_key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05005911
Hong Liu567deaf2005-08-31 18:07:22 +08005912 if (!priv->ieee->host_mc_decrypt)
5913 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_CCM);
James Ketrenosb095c382005-08-24 22:04:42 -05005914 break;
5915 case SEC_LEVEL_2:
Zhu Yid8bad6d2005-07-13 12:25:38 -05005916 if (priv->ieee->sec.flags & SEC_ACTIVE_KEY)
5917 ipw_send_tgi_tx_key(priv,
5918 DCT_FLAG_EXT_SECURITY_TKIP,
5919 priv->ieee->sec.active_key);
James Ketrenosb095c382005-08-24 22:04:42 -05005920 break;
5921 case SEC_LEVEL_1:
5922 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Hong Liu29cb8432005-09-12 10:43:33 -05005923 ipw_set_hw_decrypt_unicast(priv, priv->ieee->sec.level);
5924 ipw_set_hw_decrypt_multicast(priv, priv->ieee->sec.level);
James Ketrenosb095c382005-08-24 22:04:42 -05005925 break;
5926 case SEC_LEVEL_0:
5927 default:
5928 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06005929 }
5930}
5931
5932static void ipw_adhoc_check(void *data)
5933{
5934 struct ipw_priv *priv = data;
Jeff Garzikbf794512005-07-31 13:07:26 -04005935
James Ketrenosafbf30a2005-08-25 00:05:33 -05005936 if (priv->missed_adhoc_beacons++ > priv->disassociate_threshold &&
James Ketrenos43f66a62005-03-25 12:31:53 -06005937 !(priv->config & CFG_ADHOC_PERSIST)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05005938 IPW_DEBUG(IPW_DL_INFO | IPW_DL_NOTIF |
5939 IPW_DL_STATE | IPW_DL_ASSOC,
5940 "Missed beacon: %d - disassociate\n",
5941 priv->missed_adhoc_beacons);
James Ketrenos43f66a62005-03-25 12:31:53 -06005942 ipw_remove_current_network(priv);
5943 ipw_disassociate(priv);
5944 return;
5945 }
5946
Jeff Garzikbf794512005-07-31 13:07:26 -04005947 queue_delayed_work(priv->workqueue, &priv->adhoc_check,
James Ketrenos43f66a62005-03-25 12:31:53 -06005948 priv->assoc_request.beacon_interval);
5949}
5950
James Ketrenosc848d0a2005-08-24 21:56:24 -05005951static void ipw_bg_adhoc_check(void *data)
5952{
5953 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08005954 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005955 ipw_adhoc_check(data);
Zhu Yi46441512006-01-24 16:37:59 +08005956 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05005957}
5958
James Ketrenos43f66a62005-03-25 12:31:53 -06005959static void ipw_debug_config(struct ipw_priv *priv)
5960{
5961 IPW_DEBUG_INFO("Scan completed, no valid APs matched "
5962 "[CFG 0x%08X]\n", priv->config);
5963 if (priv->config & CFG_STATIC_CHANNEL)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005964 IPW_DEBUG_INFO("Channel locked to %d\n", priv->channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06005965 else
5966 IPW_DEBUG_INFO("Channel unlocked.\n");
5967 if (priv->config & CFG_STATIC_ESSID)
Jeff Garzikbf794512005-07-31 13:07:26 -04005968 IPW_DEBUG_INFO("ESSID locked to '%s'\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005969 escape_essid(priv->essid, priv->essid_len));
James Ketrenos43f66a62005-03-25 12:31:53 -06005970 else
5971 IPW_DEBUG_INFO("ESSID unlocked.\n");
5972 if (priv->config & CFG_STATIC_BSSID)
James Ketrenosea2b26e2005-08-24 21:25:16 -05005973 IPW_DEBUG_INFO("BSSID locked to " MAC_FMT "\n",
5974 MAC_ARG(priv->bssid));
James Ketrenos43f66a62005-03-25 12:31:53 -06005975 else
5976 IPW_DEBUG_INFO("BSSID unlocked.\n");
5977 if (priv->capability & CAP_PRIVACY_ON)
5978 IPW_DEBUG_INFO("PRIVACY on\n");
5979 else
5980 IPW_DEBUG_INFO("PRIVACY off\n");
5981 IPW_DEBUG_INFO("RATE MASK: 0x%08X\n", priv->rates_mask);
5982}
James Ketrenos43f66a62005-03-25 12:31:53 -06005983
Arjan van de Ven858119e2006-01-14 13:20:43 -08005984static void ipw_set_fixed_rate(struct ipw_priv *priv, int mode)
James Ketrenos43f66a62005-03-25 12:31:53 -06005985{
5986 /* TODO: Verify that this works... */
5987 struct ipw_fixed_rate fr = {
5988 .tx_rates = priv->rates_mask
5989 };
5990 u32 reg;
5991 u16 mask = 0;
5992
Jeff Garzikbf794512005-07-31 13:07:26 -04005993 /* Identify 'current FW band' and match it with the fixed
James Ketrenos43f66a62005-03-25 12:31:53 -06005994 * Tx rates */
Jeff Garzikbf794512005-07-31 13:07:26 -04005995
James Ketrenos43f66a62005-03-25 12:31:53 -06005996 switch (priv->ieee->freq_band) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04005997 case IEEE80211_52GHZ_BAND: /* A only */
James Ketrenos43f66a62005-03-25 12:31:53 -06005998 /* IEEE_A */
5999 if (priv->rates_mask & ~IEEE80211_OFDM_RATES_MASK) {
6000 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006001 IPW_DEBUG_WX
6002 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006003 fr.tx_rates = 0;
6004 break;
6005 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006006
James Ketrenos43f66a62005-03-25 12:31:53 -06006007 fr.tx_rates >>= IEEE80211_OFDM_SHIFT_MASK_A;
6008 break;
6009
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006010 default: /* 2.4Ghz or Mixed */
James Ketrenos43f66a62005-03-25 12:31:53 -06006011 /* IEEE_B */
James Ketrenosb095c382005-08-24 22:04:42 -05006012 if (mode == IEEE_B) {
James Ketrenos43f66a62005-03-25 12:31:53 -06006013 if (fr.tx_rates & ~IEEE80211_CCK_RATES_MASK) {
6014 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006015 IPW_DEBUG_WX
6016 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006017 fr.tx_rates = 0;
6018 }
6019 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04006020 }
James Ketrenos43f66a62005-03-25 12:31:53 -06006021
6022 /* IEEE_G */
6023 if (fr.tx_rates & ~(IEEE80211_CCK_RATES_MASK |
6024 IEEE80211_OFDM_RATES_MASK)) {
6025 /* Invalid fixed rate mask */
James Ketrenosea2b26e2005-08-24 21:25:16 -05006026 IPW_DEBUG_WX
6027 ("invalid fixed rate mask in ipw_set_fixed_rate\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06006028 fr.tx_rates = 0;
6029 break;
6030 }
6031
6032 if (IEEE80211_OFDM_RATE_6MB_MASK & fr.tx_rates) {
6033 mask |= (IEEE80211_OFDM_RATE_6MB_MASK >> 1);
6034 fr.tx_rates &= ~IEEE80211_OFDM_RATE_6MB_MASK;
6035 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006036
James Ketrenos43f66a62005-03-25 12:31:53 -06006037 if (IEEE80211_OFDM_RATE_9MB_MASK & fr.tx_rates) {
6038 mask |= (IEEE80211_OFDM_RATE_9MB_MASK >> 1);
6039 fr.tx_rates &= ~IEEE80211_OFDM_RATE_9MB_MASK;
6040 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006041
James Ketrenos43f66a62005-03-25 12:31:53 -06006042 if (IEEE80211_OFDM_RATE_12MB_MASK & fr.tx_rates) {
6043 mask |= (IEEE80211_OFDM_RATE_12MB_MASK >> 1);
6044 fr.tx_rates &= ~IEEE80211_OFDM_RATE_12MB_MASK;
6045 }
Jeff Garzikbf794512005-07-31 13:07:26 -04006046
James Ketrenos43f66a62005-03-25 12:31:53 -06006047 fr.tx_rates |= mask;
6048 break;
6049 }
6050
6051 reg = ipw_read32(priv, IPW_MEM_FIXED_OVERRIDE);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04006052 ipw_write_reg32(priv, reg, *(u32 *) & fr);
James Ketrenos43f66a62005-03-25 12:31:53 -06006053}
6054
James Ketrenosea2b26e2005-08-24 21:25:16 -05006055static void ipw_abort_scan(struct ipw_priv *priv)
6056{
6057 int err;
6058
6059 if (priv->status & STATUS_SCAN_ABORTING) {
6060 IPW_DEBUG_HC("Ignoring concurrent scan abort request.\n");
6061 return;
6062 }
6063 priv->status |= STATUS_SCAN_ABORTING;
6064
6065 err = ipw_send_scan_abort(priv);
6066 if (err)
6067 IPW_DEBUG_HC("Request to abort scan failed.\n");
6068}
6069
James Ketrenosafbf30a2005-08-25 00:05:33 -05006070static void ipw_add_scan_channels(struct ipw_priv *priv,
6071 struct ipw_scan_request_ext *scan,
6072 int scan_type)
6073{
6074 int channel_index = 0;
6075 const struct ieee80211_geo *geo;
6076 int i;
6077
Larry Finger1867b112006-02-28 09:48:28 -06006078 geo = ieee80211_get_geo(priv->ieee);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006079
6080 if (priv->ieee->freq_band & IEEE80211_52GHZ_BAND) {
6081 int start = channel_index;
6082 for (i = 0; i < geo->a_channels; i++) {
6083 if ((priv->status & STATUS_ASSOCIATED) &&
6084 geo->a[i].channel == priv->channel)
6085 continue;
6086 channel_index++;
6087 scan->channels_list[channel_index] = geo->a[i].channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006088 ipw_set_scan_type(scan, channel_index,
6089 geo->a[i].
6090 flags & IEEE80211_CH_PASSIVE_ONLY ?
6091 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN :
6092 scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006093 }
6094
6095 if (start != channel_index) {
6096 scan->channels_list[start] = (u8) (IPW_A_MODE << 6) |
6097 (channel_index - start);
6098 channel_index++;
6099 }
6100 }
6101
6102 if (priv->ieee->freq_band & IEEE80211_24GHZ_BAND) {
6103 int start = channel_index;
6104 if (priv->config & CFG_SPEED_SCAN) {
Liu Hong1fe0adb2005-08-19 09:33:10 -05006105 int index;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006106 u8 channels[IEEE80211_24GHZ_CHANNELS] = {
6107 /* nop out the list */
6108 [0] = 0
6109 };
6110
6111 u8 channel;
6112 while (channel_index < IPW_SCAN_CHANNELS) {
6113 channel =
6114 priv->speed_scan[priv->speed_scan_pos];
6115 if (channel == 0) {
6116 priv->speed_scan_pos = 0;
6117 channel = priv->speed_scan[0];
6118 }
6119 if ((priv->status & STATUS_ASSOCIATED) &&
6120 channel == priv->channel) {
6121 priv->speed_scan_pos++;
6122 continue;
6123 }
6124
6125 /* If this channel has already been
6126 * added in scan, break from loop
6127 * and this will be the first channel
6128 * in the next scan.
6129 */
6130 if (channels[channel - 1] != 0)
6131 break;
6132
6133 channels[channel - 1] = 1;
6134 priv->speed_scan_pos++;
6135 channel_index++;
6136 scan->channels_list[channel_index] = channel;
Liu Hong1fe0adb2005-08-19 09:33:10 -05006137 index =
Larry Finger1867b112006-02-28 09:48:28 -06006138 ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006139 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006140 geo->bg[index].
6141 flags &
6142 IEEE80211_CH_PASSIVE_ONLY ?
6143 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6144 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006145 }
6146 } else {
6147 for (i = 0; i < geo->bg_channels; i++) {
6148 if ((priv->status & STATUS_ASSOCIATED) &&
6149 geo->bg[i].channel == priv->channel)
6150 continue;
6151 channel_index++;
6152 scan->channels_list[channel_index] =
6153 geo->bg[i].channel;
6154 ipw_set_scan_type(scan, channel_index,
Liu Hong1fe0adb2005-08-19 09:33:10 -05006155 geo->bg[i].
6156 flags &
6157 IEEE80211_CH_PASSIVE_ONLY ?
6158 IPW_SCAN_PASSIVE_FULL_DWELL_SCAN
6159 : scan_type);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006160 }
6161 }
6162
6163 if (start != channel_index) {
6164 scan->channels_list[start] = (u8) (IPW_B_MODE << 6) |
6165 (channel_index - start);
6166 }
6167 }
6168}
6169
Zhu Yi094c4d22006-08-21 11:39:03 +08006170static int ipw_request_scan_helper(struct ipw_priv *priv, int type)
James Ketrenosea2b26e2005-08-24 21:25:16 -05006171{
6172 struct ipw_scan_request_ext scan;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006173 int err = 0, scan_type;
6174
6175 if (!(priv->status & STATUS_INIT) ||
6176 (priv->status & STATUS_EXIT_PENDING))
6177 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006178
Zhu Yi46441512006-01-24 16:37:59 +08006179 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006180
James Ketrenosea2b26e2005-08-24 21:25:16 -05006181 if (priv->status & STATUS_SCANNING) {
James Ketrenosa613bff2005-08-24 21:43:11 -05006182 IPW_DEBUG_HC("Concurrent scan requested. Ignoring.\n");
James Ketrenosea2b26e2005-08-24 21:25:16 -05006183 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006184 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006185 }
6186
James Ketrenosafbf30a2005-08-25 00:05:33 -05006187 if (!(priv->status & STATUS_SCAN_FORCED) &&
6188 priv->status & STATUS_SCAN_ABORTING) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006189 IPW_DEBUG_HC("Scan request while abort pending. Queuing.\n");
6190 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006191 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006192 }
6193
6194 if (priv->status & STATUS_RF_KILL_MASK) {
6195 IPW_DEBUG_HC("Aborting scan due to RF Kill activation\n");
6196 priv->status |= STATUS_SCAN_PENDING;
James Ketrenosb095c382005-08-24 22:04:42 -05006197 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006198 }
6199
6200 memset(&scan, 0, sizeof(scan));
Zhu Yi094c4d22006-08-21 11:39:03 +08006201 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
James Ketrenosea2b26e2005-08-24 21:25:16 -05006202
Zhu Yi094c4d22006-08-21 11:39:03 +08006203 if (type == IW_SCAN_TYPE_PASSIVE) {
6204 IPW_DEBUG_WX("use passive scanning\n");
6205 scan_type = IPW_SCAN_PASSIVE_FULL_DWELL_SCAN;
6206 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
6207 cpu_to_le16(120);
6208 ipw_add_scan_channels(priv, &scan, scan_type);
6209 goto send_request;
6210 }
6211
6212 /* Use active scan by default. */
6213 if (priv->config & CFG_SPEED_SCAN)
James Ketrenosb095c382005-08-24 22:04:42 -05006214 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006215 cpu_to_le16(30);
James Ketrenosb095c382005-08-24 22:04:42 -05006216 else
6217 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006218 cpu_to_le16(20);
James Ketrenosb095c382005-08-24 22:04:42 -05006219
James Ketrenosa613bff2005-08-24 21:43:11 -05006220 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006221 cpu_to_le16(20);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006222
Zhu Yi094c4d22006-08-21 11:39:03 +08006223 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006224
James Ketrenosb095c382005-08-24 22:04:42 -05006225#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006226 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006227 u8 channel;
James Ketrenosb095c382005-08-24 22:04:42 -05006228 u8 band = 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006229
Larry Finger1867b112006-02-28 09:48:28 -06006230 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006231 case IEEE80211_52GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006232 band = (u8) (IPW_A_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006233 channel = priv->channel;
6234 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006235
James Ketrenosb095c382005-08-24 22:04:42 -05006236 case IEEE80211_24GHZ_BAND:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006237 band = (u8) (IPW_B_MODE << 6) | 1;
James Ketrenosb095c382005-08-24 22:04:42 -05006238 channel = priv->channel;
6239 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006240
James Ketrenosb095c382005-08-24 22:04:42 -05006241 default:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006242 band = (u8) (IPW_B_MODE << 6) | 1;
6243 channel = 9;
James Ketrenosb095c382005-08-24 22:04:42 -05006244 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006245 }
6246
James Ketrenosb095c382005-08-24 22:04:42 -05006247 scan.channels_list[0] = band;
6248 scan.channels_list[1] = channel;
6249 ipw_set_scan_type(&scan, 1, IPW_SCAN_PASSIVE_FULL_DWELL_SCAN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006250
James Ketrenosb095c382005-08-24 22:04:42 -05006251 /* NOTE: The card will sit on this channel for this time
6252 * period. Scan aborts are timing sensitive and frequently
6253 * result in firmware restarts. As such, it is best to
6254 * set a small dwell_time here and just keep re-issuing
6255 * scans. Otherwise fast channel hopping will not actually
6256 * hop channels.
6257 *
6258 * TODO: Move SPEED SCAN support to all modes and bands */
James Ketrenosa613bff2005-08-24 21:43:11 -05006259 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] =
Zhu Yi094c4d22006-08-21 11:39:03 +08006260 cpu_to_le16(2000);
James Ketrenosea2b26e2005-08-24 21:25:16 -05006261 } else {
James Ketrenosb095c382005-08-24 22:04:42 -05006262#endif /* CONFIG_IPW2200_MONITOR */
6263 /* If we are roaming, then make this a directed scan for the
6264 * current network. Otherwise, ensure that every other scan
6265 * is a fast channel hop scan */
6266 if ((priv->status & STATUS_ROAMING)
6267 || (!(priv->status & STATUS_ASSOCIATED)
6268 && (priv->config & CFG_STATIC_ESSID)
6269 && (le32_to_cpu(scan.full_scan_index) % 2))) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006270 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
6271 if (err) {
James Ketrenosb095c382005-08-24 22:04:42 -05006272 IPW_DEBUG_HC("Attempt to send SSID command "
6273 "failed.\n");
6274 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006275 }
6276
6277 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006278 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05006279 scan_type = IPW_SCAN_ACTIVE_BROADCAST_SCAN;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006280
James Ketrenosafbf30a2005-08-25 00:05:33 -05006281 ipw_add_scan_channels(priv, &scan, scan_type);
James Ketrenosb095c382005-08-24 22:04:42 -05006282#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05006283 }
6284#endif
6285
Zhu Yi094c4d22006-08-21 11:39:03 +08006286send_request:
James Ketrenosea2b26e2005-08-24 21:25:16 -05006287 err = ipw_send_scan_request_ext(priv, &scan);
6288 if (err) {
6289 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
James Ketrenosb095c382005-08-24 22:04:42 -05006290 goto done;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006291 }
6292
6293 priv->status |= STATUS_SCANNING;
6294 priv->status &= ~STATUS_SCAN_PENDING;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006295 queue_delayed_work(priv->workqueue, &priv->scan_check,
6296 IPW_SCAN_CHECK_WATCHDOG);
Zhu Yi094c4d22006-08-21 11:39:03 +08006297done:
Zhu Yi46441512006-01-24 16:37:59 +08006298 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05006299 return err;
James Ketrenosc848d0a2005-08-24 21:56:24 -05006300}
6301
Zhu Yi094c4d22006-08-21 11:39:03 +08006302static int ipw_request_passive_scan(struct ipw_priv *priv) {
6303 return ipw_request_scan_helper(priv, IW_SCAN_TYPE_PASSIVE);
6304}
6305
6306static int ipw_request_scan(struct ipw_priv *priv) {
6307 return ipw_request_scan_helper(priv, IW_SCAN_TYPE_ACTIVE);
6308}
6309
James Ketrenosc848d0a2005-08-24 21:56:24 -05006310static void ipw_bg_abort_scan(void *data)
6311{
6312 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08006313 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006314 ipw_abort_scan(data);
Zhu Yi46441512006-01-24 16:37:59 +08006315 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05006316}
6317
James Ketrenosea2b26e2005-08-24 21:25:16 -05006318static int ipw_wpa_enable(struct ipw_priv *priv, int value)
6319{
James Ketrenosb095c382005-08-24 22:04:42 -05006320 /* This is called when wpa_supplicant loads and closes the driver
6321 * interface. */
Hong Liucdd1fa12005-08-31 18:14:27 +08006322 priv->ieee->wpa_enabled = value;
James Ketrenosb095c382005-08-24 22:04:42 -05006323 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006324}
6325
James Ketrenosea2b26e2005-08-24 21:25:16 -05006326static int ipw_wpa_set_auth_algs(struct ipw_priv *priv, int value)
6327{
6328 struct ieee80211_device *ieee = priv->ieee;
6329 struct ieee80211_security sec = {
6330 .flags = SEC_AUTH_MODE,
6331 };
6332 int ret = 0;
6333
James Ketrenosafbf30a2005-08-25 00:05:33 -05006334 if (value & IW_AUTH_ALG_SHARED_KEY) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006335 sec.auth_mode = WLAN_AUTH_SHARED_KEY;
6336 ieee->open_wep = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006337 } else if (value & IW_AUTH_ALG_OPEN_SYSTEM) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05006338 sec.auth_mode = WLAN_AUTH_OPEN;
6339 ieee->open_wep = 1;
Zhu Yi3e234b42006-01-24 16:36:52 +08006340 } else if (value & IW_AUTH_ALG_LEAP) {
6341 sec.auth_mode = WLAN_AUTH_LEAP;
6342 ieee->open_wep = 1;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006343 } else
6344 return -EINVAL;
James Ketrenosea2b26e2005-08-24 21:25:16 -05006345
6346 if (ieee->set_security)
6347 ieee->set_security(ieee->dev, &sec);
6348 else
6349 ret = -EOPNOTSUPP;
6350
6351 return ret;
6352}
6353
Adrian Bunka73e22b2006-01-21 01:39:42 +01006354static void ipw_wpa_assoc_frame(struct ipw_priv *priv, char *wpa_ie,
6355 int wpa_ie_len)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006356{
6357 /* make sure WPA is enabled */
6358 ipw_wpa_enable(priv, 1);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006359}
6360
6361static int ipw_set_rsn_capa(struct ipw_priv *priv,
6362 char *capabilities, int length)
6363{
James Ketrenosafbf30a2005-08-25 00:05:33 -05006364 IPW_DEBUG_HC("HOST_CMD_RSN_CAPABILITIES\n");
6365
Zhu Yi0a7bcf22006-01-24 16:37:28 +08006366 return ipw_send_cmd_pdu(priv, IPW_CMD_RSN_CAPABILITIES, length,
Zhu Yi2638bc32006-01-24 16:37:52 +08006367 capabilities);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006368}
6369
James Ketrenosafbf30a2005-08-25 00:05:33 -05006370/*
6371 * WE-18 support
6372 */
6373
6374/* SIOCSIWGENIE */
6375static int ipw_wx_set_genie(struct net_device *dev,
6376 struct iw_request_info *info,
6377 union iwreq_data *wrqu, char *extra)
6378{
6379 struct ipw_priv *priv = ieee80211_priv(dev);
6380 struct ieee80211_device *ieee = priv->ieee;
6381 u8 *buf;
6382 int err = 0;
6383
6384 if (wrqu->data.length > MAX_WPA_IE_LEN ||
6385 (wrqu->data.length && extra == NULL))
6386 return -EINVAL;
6387
James Ketrenosafbf30a2005-08-25 00:05:33 -05006388 if (wrqu->data.length) {
6389 buf = kmalloc(wrqu->data.length, GFP_KERNEL);
6390 if (buf == NULL) {
6391 err = -ENOMEM;
6392 goto out;
6393 }
6394
6395 memcpy(buf, extra, wrqu->data.length);
6396 kfree(ieee->wpa_ie);
6397 ieee->wpa_ie = buf;
6398 ieee->wpa_ie_len = wrqu->data.length;
6399 } else {
6400 kfree(ieee->wpa_ie);
6401 ieee->wpa_ie = NULL;
6402 ieee->wpa_ie_len = 0;
6403 }
6404
6405 ipw_wpa_assoc_frame(priv, ieee->wpa_ie, ieee->wpa_ie_len);
6406 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006407 return err;
6408}
6409
6410/* SIOCGIWGENIE */
6411static int ipw_wx_get_genie(struct net_device *dev,
6412 struct iw_request_info *info,
6413 union iwreq_data *wrqu, char *extra)
6414{
6415 struct ipw_priv *priv = ieee80211_priv(dev);
6416 struct ieee80211_device *ieee = priv->ieee;
6417 int err = 0;
6418
James Ketrenosafbf30a2005-08-25 00:05:33 -05006419 if (ieee->wpa_ie_len == 0 || ieee->wpa_ie == NULL) {
6420 wrqu->data.length = 0;
6421 goto out;
6422 }
6423
6424 if (wrqu->data.length < ieee->wpa_ie_len) {
6425 err = -E2BIG;
6426 goto out;
6427 }
6428
6429 wrqu->data.length = ieee->wpa_ie_len;
6430 memcpy(extra, ieee->wpa_ie, ieee->wpa_ie_len);
6431
6432 out:
James Ketrenosafbf30a2005-08-25 00:05:33 -05006433 return err;
6434}
6435
Zhu Yi1fbfea52005-08-05 17:22:56 +08006436static int wext_cipher2level(int cipher)
6437{
6438 switch (cipher) {
6439 case IW_AUTH_CIPHER_NONE:
6440 return SEC_LEVEL_0;
6441 case IW_AUTH_CIPHER_WEP40:
6442 case IW_AUTH_CIPHER_WEP104:
6443 return SEC_LEVEL_1;
6444 case IW_AUTH_CIPHER_TKIP:
6445 return SEC_LEVEL_2;
6446 case IW_AUTH_CIPHER_CCMP:
6447 return SEC_LEVEL_3;
6448 default:
6449 return -1;
6450 }
6451}
6452
James Ketrenosafbf30a2005-08-25 00:05:33 -05006453/* SIOCSIWAUTH */
6454static int ipw_wx_set_auth(struct net_device *dev,
6455 struct iw_request_info *info,
6456 union iwreq_data *wrqu, char *extra)
6457{
6458 struct ipw_priv *priv = ieee80211_priv(dev);
6459 struct ieee80211_device *ieee = priv->ieee;
6460 struct iw_param *param = &wrqu->param;
6461 struct ieee80211_crypt_data *crypt;
6462 unsigned long flags;
6463 int ret = 0;
6464
6465 switch (param->flags & IW_AUTH_INDEX) {
6466 case IW_AUTH_WPA_VERSION:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006467 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006468 case IW_AUTH_CIPHER_PAIRWISE:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006469 ipw_set_hw_decrypt_unicast(priv,
6470 wext_cipher2level(param->value));
6471 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006472 case IW_AUTH_CIPHER_GROUP:
Zhu Yi1fbfea52005-08-05 17:22:56 +08006473 ipw_set_hw_decrypt_multicast(priv,
6474 wext_cipher2level(param->value));
6475 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006476 case IW_AUTH_KEY_MGMT:
6477 /*
6478 * ipw2200 does not use these parameters
6479 */
6480 break;
6481
6482 case IW_AUTH_TKIP_COUNTERMEASURES:
6483 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006484 if (!crypt || !crypt->ops->set_flags || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006485 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006486
6487 flags = crypt->ops->get_flags(crypt->priv);
6488
6489 if (param->value)
6490 flags |= IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6491 else
6492 flags &= ~IEEE80211_CRYPTO_TKIP_COUNTERMEASURES;
6493
6494 crypt->ops->set_flags(flags, crypt->priv);
6495
6496 break;
6497
6498 case IW_AUTH_DROP_UNENCRYPTED:{
6499 /* HACK:
6500 *
6501 * wpa_supplicant calls set_wpa_enabled when the driver
6502 * is loaded and unloaded, regardless of if WPA is being
6503 * used. No other calls are made which can be used to
6504 * determine if encryption will be used or not prior to
6505 * association being expected. If encryption is not being
6506 * used, drop_unencrypted is set to false, else true -- we
6507 * can use this to determine if the CAP_PRIVACY_ON bit should
6508 * be set.
6509 */
6510 struct ieee80211_security sec = {
6511 .flags = SEC_ENABLED,
6512 .enabled = param->value,
6513 };
6514 priv->ieee->drop_unencrypted = param->value;
6515 /* We only change SEC_LEVEL for open mode. Others
6516 * are set by ipw_wpa_set_encryption.
6517 */
6518 if (!param->value) {
6519 sec.flags |= SEC_LEVEL;
6520 sec.level = SEC_LEVEL_0;
6521 } else {
6522 sec.flags |= SEC_LEVEL;
6523 sec.level = SEC_LEVEL_1;
6524 }
6525 if (priv->ieee->set_security)
6526 priv->ieee->set_security(priv->ieee->dev, &sec);
6527 break;
6528 }
6529
6530 case IW_AUTH_80211_AUTH_ALG:
6531 ret = ipw_wpa_set_auth_algs(priv, param->value);
6532 break;
6533
6534 case IW_AUTH_WPA_ENABLED:
6535 ret = ipw_wpa_enable(priv, param->value);
Zhu Yie3c5a642006-04-13 17:21:13 +08006536 ipw_disassociate(priv);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006537 break;
6538
6539 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6540 ieee->ieee802_1x = param->value;
6541 break;
6542
James Ketrenosafbf30a2005-08-25 00:05:33 -05006543 case IW_AUTH_PRIVACY_INVOKED:
6544 ieee->privacy_invoked = param->value;
6545 break;
6546
6547 default:
6548 return -EOPNOTSUPP;
6549 }
6550 return ret;
6551}
6552
6553/* SIOCGIWAUTH */
6554static int ipw_wx_get_auth(struct net_device *dev,
6555 struct iw_request_info *info,
6556 union iwreq_data *wrqu, char *extra)
6557{
6558 struct ipw_priv *priv = ieee80211_priv(dev);
6559 struct ieee80211_device *ieee = priv->ieee;
6560 struct ieee80211_crypt_data *crypt;
6561 struct iw_param *param = &wrqu->param;
6562 int ret = 0;
6563
6564 switch (param->flags & IW_AUTH_INDEX) {
6565 case IW_AUTH_WPA_VERSION:
6566 case IW_AUTH_CIPHER_PAIRWISE:
6567 case IW_AUTH_CIPHER_GROUP:
6568 case IW_AUTH_KEY_MGMT:
6569 /*
6570 * wpa_supplicant will control these internally
6571 */
6572 ret = -EOPNOTSUPP;
6573 break;
6574
6575 case IW_AUTH_TKIP_COUNTERMEASURES:
6576 crypt = priv->ieee->crypt[priv->ieee->tx_keyidx];
James Ketrenos991d1cc2005-10-13 09:26:48 +00006577 if (!crypt || !crypt->ops->get_flags)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006578 break;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006579
6580 param->value = (crypt->ops->get_flags(crypt->priv) &
6581 IEEE80211_CRYPTO_TKIP_COUNTERMEASURES) ? 1 : 0;
6582
6583 break;
6584
6585 case IW_AUTH_DROP_UNENCRYPTED:
6586 param->value = ieee->drop_unencrypted;
6587 break;
6588
6589 case IW_AUTH_80211_AUTH_ALG:
6590 param->value = ieee->sec.auth_mode;
6591 break;
6592
6593 case IW_AUTH_WPA_ENABLED:
6594 param->value = ieee->wpa_enabled;
6595 break;
6596
6597 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
6598 param->value = ieee->ieee802_1x;
6599 break;
6600
6601 case IW_AUTH_ROAMING_CONTROL:
6602 case IW_AUTH_PRIVACY_INVOKED:
6603 param->value = ieee->privacy_invoked;
6604 break;
6605
6606 default:
6607 return -EOPNOTSUPP;
6608 }
6609 return 0;
6610}
6611
6612/* SIOCSIWENCODEEXT */
6613static int ipw_wx_set_encodeext(struct net_device *dev,
6614 struct iw_request_info *info,
6615 union iwreq_data *wrqu, char *extra)
6616{
6617 struct ipw_priv *priv = ieee80211_priv(dev);
6618 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
6619
6620 if (hwcrypto) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006621 if (ext->alg == IW_ENCODE_ALG_TKIP) {
Hong Liu567deaf2005-08-31 18:07:22 +08006622 /* IPW HW can't build TKIP MIC,
6623 host decryption still needed */
6624 if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
6625 priv->ieee->host_mc_decrypt = 1;
6626 else {
6627 priv->ieee->host_encrypt = 0;
6628 priv->ieee->host_encrypt_msdu = 1;
6629 priv->ieee->host_decrypt = 1;
6630 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006631 } else {
6632 priv->ieee->host_encrypt = 0;
6633 priv->ieee->host_encrypt_msdu = 0;
6634 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08006635 priv->ieee->host_mc_decrypt = 0;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006636 }
6637 }
6638
6639 return ieee80211_wx_set_encodeext(priv->ieee, info, wrqu, extra);
6640}
6641
6642/* SIOCGIWENCODEEXT */
6643static int ipw_wx_get_encodeext(struct net_device *dev,
6644 struct iw_request_info *info,
6645 union iwreq_data *wrqu, char *extra)
6646{
6647 struct ipw_priv *priv = ieee80211_priv(dev);
6648 return ieee80211_wx_get_encodeext(priv->ieee, info, wrqu, extra);
6649}
6650
6651/* SIOCSIWMLME */
6652static int ipw_wx_set_mlme(struct net_device *dev,
6653 struct iw_request_info *info,
6654 union iwreq_data *wrqu, char *extra)
6655{
6656 struct ipw_priv *priv = ieee80211_priv(dev);
6657 struct iw_mlme *mlme = (struct iw_mlme *)extra;
6658 u16 reason;
6659
6660 reason = cpu_to_le16(mlme->reason_code);
6661
6662 switch (mlme->cmd) {
6663 case IW_MLME_DEAUTH:
Pavel Machek67fd6b42006-07-11 15:34:05 +02006664 /* silently ignore */
James Ketrenosafbf30a2005-08-25 00:05:33 -05006665 break;
6666
6667 case IW_MLME_DISASSOC:
6668 ipw_disassociate(priv);
6669 break;
6670
6671 default:
6672 return -EOPNOTSUPP;
6673 }
6674 return 0;
6675}
James Ketrenosea2b26e2005-08-24 21:25:16 -05006676
Zhu Yie43e3c12006-04-13 17:20:45 +08006677#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05006678
6679/* QoS */
6680/*
6681* get the modulation type of the current network or
6682* the card current mode
6683*/
Adrian Bunk53d0bcf2006-03-04 13:14:31 +01006684static u8 ipw_qos_current_mode(struct ipw_priv * priv)
James Ketrenosb095c382005-08-24 22:04:42 -05006685{
6686 u8 mode = 0;
6687
6688 if (priv->status & STATUS_ASSOCIATED) {
6689 unsigned long flags;
6690
6691 spin_lock_irqsave(&priv->ieee->lock, flags);
6692 mode = priv->assoc_network->mode;
6693 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6694 } else {
6695 mode = priv->ieee->mode;
6696 }
6697 IPW_DEBUG_QOS("QoS network/card mode %d \n", mode);
6698 return mode;
6699}
6700
6701/*
6702* Handle management frame beacon and probe response
6703*/
James Ketrenos3b9990c2005-08-19 13:18:55 -05006704static int ipw_qos_handle_probe_response(struct ipw_priv *priv,
6705 int active_network,
6706 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05006707{
6708 u32 size = sizeof(struct ieee80211_qos_parameters);
6709
James Ketrenosafbf30a2005-08-25 00:05:33 -05006710 if (network->capability & WLAN_CAPABILITY_IBSS)
James Ketrenosb095c382005-08-24 22:04:42 -05006711 network->qos_data.active = network->qos_data.supported;
6712
6713 if (network->flags & NETWORK_HAS_QOS_MASK) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006714 if (active_network &&
6715 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
James Ketrenosb095c382005-08-24 22:04:42 -05006716 network->qos_data.active = network->qos_data.supported;
6717
6718 if ((network->qos_data.active == 1) && (active_network == 1) &&
6719 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
6720 (network->qos_data.old_param_count !=
6721 network->qos_data.param_count)) {
6722 network->qos_data.old_param_count =
6723 network->qos_data.param_count;
6724 schedule_work(&priv->qos_activate);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006725 IPW_DEBUG_QOS("QoS parameters change call "
6726 "qos_activate\n");
James Ketrenosb095c382005-08-24 22:04:42 -05006727 }
6728 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006729 if ((priv->ieee->mode == IEEE_B) || (network->mode == IEEE_B))
6730 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006731 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006732 else
6733 memcpy(&network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006734 &def_parameters_OFDM, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006735
James Ketrenosb095c382005-08-24 22:04:42 -05006736 if ((network->qos_data.active == 1) && (active_network == 1)) {
6737 IPW_DEBUG_QOS("QoS was disabled call qos_activate \n");
6738 schedule_work(&priv->qos_activate);
6739 }
6740
6741 network->qos_data.active = 0;
6742 network->qos_data.supported = 0;
6743 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006744 if ((priv->status & STATUS_ASSOCIATED) &&
6745 (priv->ieee->iw_mode == IW_MODE_ADHOC) && (active_network == 0)) {
6746 if (memcmp(network->bssid, priv->bssid, ETH_ALEN))
6747 if ((network->capability & WLAN_CAPABILITY_IBSS) &&
6748 !(network->flags & NETWORK_EMPTY_ESSID))
James Ketrenosb095c382005-08-24 22:04:42 -05006749 if ((network->ssid_len ==
James Ketrenosafbf30a2005-08-25 00:05:33 -05006750 priv->assoc_network->ssid_len) &&
6751 !memcmp(network->ssid,
6752 priv->assoc_network->ssid,
6753 network->ssid_len)) {
James Ketrenosb095c382005-08-24 22:04:42 -05006754 queue_work(priv->workqueue,
6755 &priv->merge_networks);
6756 }
James Ketrenosb095c382005-08-24 22:04:42 -05006757 }
6758
6759 return 0;
6760}
6761
6762/*
6763* This function set up the firmware to support QoS. It sends
6764* IPW_CMD_QOS_PARAMETERS and IPW_CMD_WME_INFO
6765*/
6766static int ipw_qos_activate(struct ipw_priv *priv,
6767 struct ieee80211_qos_data *qos_network_data)
6768{
6769 int err;
6770 struct ieee80211_qos_parameters qos_parameters[QOS_QOS_SETS];
6771 struct ieee80211_qos_parameters *active_one = NULL;
6772 u32 size = sizeof(struct ieee80211_qos_parameters);
6773 u32 burst_duration;
6774 int i;
6775 u8 type;
6776
6777 type = ipw_qos_current_mode(priv);
6778
6779 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_CCK]);
6780 memcpy(active_one, priv->qos_data.def_qos_parm_CCK, size);
6781 active_one = &(qos_parameters[QOS_PARAM_SET_DEF_OFDM]);
6782 memcpy(active_one, priv->qos_data.def_qos_parm_OFDM, size);
6783
6784 if (qos_network_data == NULL) {
6785 if (type == IEEE_B) {
6786 IPW_DEBUG_QOS("QoS activate network mode %d\n", type);
6787 active_one = &def_parameters_CCK;
6788 } else
6789 active_one = &def_parameters_OFDM;
6790
James Ketrenosafbf30a2005-08-25 00:05:33 -05006791 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006792 burst_duration = ipw_qos_get_burst_duration(priv);
6793 for (i = 0; i < QOS_QUEUE_NUM; i++)
James Ketrenosafbf30a2005-08-25 00:05:33 -05006794 qos_parameters[QOS_PARAM_SET_ACTIVE].tx_op_limit[i] =
Zhu Yi851ca262006-08-21 11:37:58 +08006795 (u16)burst_duration;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006796 } else if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
James Ketrenosb095c382005-08-24 22:04:42 -05006797 if (type == IEEE_B) {
6798 IPW_DEBUG_QOS("QoS activate IBSS nework mode %d\n",
6799 type);
6800 if (priv->qos_data.qos_enable == 0)
6801 active_one = &def_parameters_CCK;
6802 else
6803 active_one = priv->qos_data.def_qos_parm_CCK;
6804 } else {
6805 if (priv->qos_data.qos_enable == 0)
6806 active_one = &def_parameters_OFDM;
6807 else
6808 active_one = priv->qos_data.def_qos_parm_OFDM;
6809 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05006810 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006811 } else {
6812 unsigned long flags;
6813 int active;
6814
6815 spin_lock_irqsave(&priv->ieee->lock, flags);
6816 active_one = &(qos_network_data->parameters);
6817 qos_network_data->old_param_count =
6818 qos_network_data->param_count;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006819 memcpy(&qos_parameters[QOS_PARAM_SET_ACTIVE], active_one, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006820 active = qos_network_data->supported;
6821 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6822
6823 if (active == 0) {
6824 burst_duration = ipw_qos_get_burst_duration(priv);
6825 for (i = 0; i < QOS_QUEUE_NUM; i++)
6826 qos_parameters[QOS_PARAM_SET_ACTIVE].
Zhu Yi851ca262006-08-21 11:37:58 +08006827 tx_op_limit[i] = (u16)burst_duration;
James Ketrenosb095c382005-08-24 22:04:42 -05006828 }
6829 }
6830
6831 IPW_DEBUG_QOS("QoS sending IPW_CMD_QOS_PARAMETERS\n");
Zhu Yi851ca262006-08-21 11:37:58 +08006832 for (i = 0; i < 3; i++) {
6833 int j;
6834 for (j = 0; j < QOS_QUEUE_NUM; j++) {
6835 qos_parameters[i].cw_min[j] = cpu_to_le16(qos_parameters[i].cw_min[j]);
6836 qos_parameters[i].cw_max[j] = cpu_to_le16(qos_parameters[i].cw_max[j]);
6837 qos_parameters[i].tx_op_limit[j] = cpu_to_le16(qos_parameters[i].tx_op_limit[j]);
6838 }
6839 }
6840
James Ketrenosafbf30a2005-08-25 00:05:33 -05006841 err = ipw_send_qos_params_command(priv,
6842 (struct ieee80211_qos_parameters *)
6843 &(qos_parameters[0]));
James Ketrenosb095c382005-08-24 22:04:42 -05006844 if (err)
6845 IPW_DEBUG_QOS("QoS IPW_CMD_QOS_PARAMETERS failed\n");
6846
6847 return err;
6848}
6849
6850/*
6851* send IPW_CMD_WME_INFO to the firmware
6852*/
6853static int ipw_qos_set_info_element(struct ipw_priv *priv)
6854{
6855 int ret = 0;
6856 struct ieee80211_qos_information_element qos_info;
6857
6858 if (priv == NULL)
6859 return -1;
6860
6861 qos_info.elementID = QOS_ELEMENT_ID;
6862 qos_info.length = sizeof(struct ieee80211_qos_information_element) - 2;
6863
6864 qos_info.version = QOS_VERSION_1;
6865 qos_info.ac_info = 0;
6866
6867 memcpy(qos_info.qui, qos_oui, QOS_OUI_LEN);
6868 qos_info.qui_type = QOS_OUI_TYPE;
6869 qos_info.qui_subtype = QOS_OUI_INFO_SUB_TYPE;
6870
6871 ret = ipw_send_qos_info_command(priv, &qos_info);
6872 if (ret != 0) {
6873 IPW_DEBUG_QOS("QoS error calling ipw_send_qos_info_command\n");
6874 }
6875 return ret;
6876}
6877
6878/*
6879* Set the QoS parameter with the association request structure
6880*/
6881static int ipw_qos_association(struct ipw_priv *priv,
6882 struct ieee80211_network *network)
6883{
6884 int err = 0;
6885 struct ieee80211_qos_data *qos_data = NULL;
6886 struct ieee80211_qos_data ibss_data = {
6887 .supported = 1,
6888 .active = 1,
6889 };
6890
6891 switch (priv->ieee->iw_mode) {
6892 case IW_MODE_ADHOC:
Eric Sesterhenn5d9428d2006-04-02 13:52:48 +02006893 BUG_ON(!(network->capability & WLAN_CAPABILITY_IBSS));
James Ketrenosb095c382005-08-24 22:04:42 -05006894
6895 qos_data = &ibss_data;
6896 break;
6897
6898 case IW_MODE_INFRA:
6899 qos_data = &network->qos_data;
6900 break;
6901
6902 default:
6903 BUG();
6904 break;
6905 }
6906
6907 err = ipw_qos_activate(priv, qos_data);
6908 if (err) {
6909 priv->assoc_request.policy_support &= ~HC_QOS_SUPPORT_ASSOC;
6910 return err;
6911 }
6912
6913 if (priv->qos_data.qos_enable && qos_data->supported) {
6914 IPW_DEBUG_QOS("QoS will be enabled for this association\n");
6915 priv->assoc_request.policy_support |= HC_QOS_SUPPORT_ASSOC;
6916 return ipw_qos_set_info_element(priv);
6917 }
6918
6919 return 0;
6920}
6921
6922/*
Matt LaPlante0779bf22006-11-30 05:24:39 +01006923* handling the beaconing responses. if we get different QoS setting
6924* off the network from the associated setting, adjust the QoS
James Ketrenosb095c382005-08-24 22:04:42 -05006925* setting
6926*/
6927static int ipw_qos_association_resp(struct ipw_priv *priv,
6928 struct ieee80211_network *network)
6929{
6930 int ret = 0;
6931 unsigned long flags;
6932 u32 size = sizeof(struct ieee80211_qos_parameters);
6933 int set_qos_param = 0;
6934
James Ketrenosafbf30a2005-08-25 00:05:33 -05006935 if ((priv == NULL) || (network == NULL) ||
6936 (priv->assoc_network == NULL))
James Ketrenosb095c382005-08-24 22:04:42 -05006937 return ret;
6938
6939 if (!(priv->status & STATUS_ASSOCIATED))
6940 return ret;
6941
James Ketrenosafbf30a2005-08-25 00:05:33 -05006942 if ((priv->ieee->iw_mode != IW_MODE_INFRA))
James Ketrenosb095c382005-08-24 22:04:42 -05006943 return ret;
James Ketrenosb095c382005-08-24 22:04:42 -05006944
6945 spin_lock_irqsave(&priv->ieee->lock, flags);
6946 if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006947 memcpy(&priv->assoc_network->qos_data, &network->qos_data,
James Ketrenosb095c382005-08-24 22:04:42 -05006948 sizeof(struct ieee80211_qos_data));
6949 priv->assoc_network->qos_data.active = 1;
6950 if ((network->qos_data.old_param_count !=
6951 network->qos_data.param_count)) {
6952 set_qos_param = 1;
6953 network->qos_data.old_param_count =
6954 network->qos_data.param_count;
6955 }
6956
6957 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05006958 if ((network->mode == IEEE_B) || (priv->ieee->mode == IEEE_B))
6959 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006960 &def_parameters_CCK, size);
James Ketrenosafbf30a2005-08-25 00:05:33 -05006961 else
6962 memcpy(&priv->assoc_network->qos_data.parameters,
James Ketrenosb095c382005-08-24 22:04:42 -05006963 &def_parameters_OFDM, size);
James Ketrenosb095c382005-08-24 22:04:42 -05006964 priv->assoc_network->qos_data.active = 0;
6965 priv->assoc_network->qos_data.supported = 0;
6966 set_qos_param = 1;
6967 }
6968
6969 spin_unlock_irqrestore(&priv->ieee->lock, flags);
6970
6971 if (set_qos_param == 1)
6972 schedule_work(&priv->qos_activate);
6973
6974 return ret;
6975}
6976
6977static u32 ipw_qos_get_burst_duration(struct ipw_priv *priv)
6978{
6979 u32 ret = 0;
6980
6981 if ((priv == NULL))
6982 return 0;
6983
James Ketrenosafbf30a2005-08-25 00:05:33 -05006984 if (!(priv->ieee->modulation & IEEE80211_OFDM_MODULATION))
James Ketrenosb095c382005-08-24 22:04:42 -05006985 ret = priv->qos_data.burst_duration_CCK;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006986 else
James Ketrenosb095c382005-08-24 22:04:42 -05006987 ret = priv->qos_data.burst_duration_OFDM;
James Ketrenosafbf30a2005-08-25 00:05:33 -05006988
James Ketrenosb095c382005-08-24 22:04:42 -05006989 return ret;
6990}
6991
6992/*
6993* Initialize the setting of QoS global
6994*/
6995static void ipw_qos_init(struct ipw_priv *priv, int enable,
6996 int burst_enable, u32 burst_duration_CCK,
6997 u32 burst_duration_OFDM)
6998{
6999 priv->qos_data.qos_enable = enable;
7000
7001 if (priv->qos_data.qos_enable) {
7002 priv->qos_data.def_qos_parm_CCK = &def_qos_parameters_CCK;
7003 priv->qos_data.def_qos_parm_OFDM = &def_qos_parameters_OFDM;
7004 IPW_DEBUG_QOS("QoS is enabled\n");
7005 } else {
7006 priv->qos_data.def_qos_parm_CCK = &def_parameters_CCK;
7007 priv->qos_data.def_qos_parm_OFDM = &def_parameters_OFDM;
7008 IPW_DEBUG_QOS("QoS is not enabled\n");
7009 }
7010
7011 priv->qos_data.burst_enable = burst_enable;
7012
7013 if (burst_enable) {
7014 priv->qos_data.burst_duration_CCK = burst_duration_CCK;
7015 priv->qos_data.burst_duration_OFDM = burst_duration_OFDM;
7016 } else {
7017 priv->qos_data.burst_duration_CCK = 0;
7018 priv->qos_data.burst_duration_OFDM = 0;
7019 }
7020}
7021
7022/*
7023* map the packet priority to the right TX Queue
7024*/
7025static int ipw_get_tx_queue_number(struct ipw_priv *priv, u16 priority)
7026{
7027 if (priority > 7 || !priv->qos_data.qos_enable)
7028 priority = 0;
7029
7030 return from_priority_to_tx_queue[priority] - 1;
7031}
7032
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007033static int ipw_is_qos_active(struct net_device *dev,
7034 struct sk_buff *skb)
James Ketrenosb095c382005-08-24 22:04:42 -05007035{
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007036 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosb095c382005-08-24 22:04:42 -05007037 struct ieee80211_qos_data *qos_data = NULL;
7038 int active, supported;
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007039 u8 *daddr = skb->data + ETH_ALEN;
7040 int unicast = !is_multicast_ether_addr(daddr);
James Ketrenosb095c382005-08-24 22:04:42 -05007041
7042 if (!(priv->status & STATUS_ASSOCIATED))
7043 return 0;
7044
7045 qos_data = &priv->assoc_network->qos_data;
7046
James Ketrenosb095c382005-08-24 22:04:42 -05007047 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7048 if (unicast == 0)
7049 qos_data->active = 0;
7050 else
7051 qos_data->active = qos_data->supported;
7052 }
James Ketrenosb095c382005-08-24 22:04:42 -05007053 active = qos_data->active;
7054 supported = qos_data->supported;
James Ketrenosafbf30a2005-08-25 00:05:33 -05007055 IPW_DEBUG_QOS("QoS %d network is QoS active %d supported %d "
7056 "unicast %d\n",
7057 priv->qos_data.qos_enable, active, supported, unicast);
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007058 if (active && priv->qos_data.qos_enable)
7059 return 1;
James Ketrenosb095c382005-08-24 22:04:42 -05007060
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007061 return 0;
7062
7063}
7064/*
7065* add QoS parameter to the TX command
7066*/
7067static int ipw_qos_set_tx_queue_command(struct ipw_priv *priv,
7068 u16 priority,
7069 struct tfd_data *tfd)
7070{
7071 int tx_queue_id = 0;
7072
7073
7074 tx_queue_id = from_priority_to_tx_queue[priority] - 1;
7075 tfd->tx_flags_ext |= DCT_FLAG_EXT_QOS_ENABLED;
7076
7077 if (priv->qos_data.qos_no_ack_mask & (1UL << tx_queue_id)) {
7078 tfd->tx_flags &= ~DCT_FLAG_ACK_REQD;
Zhu Yi851ca262006-08-21 11:37:58 +08007079 tfd->tfd.tfd_26.mchdr.qos_ctrl |= cpu_to_le16(CTRL_QOS_NO_ACK);
James Ketrenosb095c382005-08-24 22:04:42 -05007080 }
Zhu Yia5cf4fe2006-04-13 17:19:11 +08007081 return 0;
James Ketrenosb095c382005-08-24 22:04:42 -05007082}
7083
7084/*
7085* background support to run QoS activate functionality
7086*/
7087static void ipw_bg_qos_activate(void *data)
7088{
7089 struct ipw_priv *priv = data;
7090
7091 if (priv == NULL)
7092 return;
7093
Zhu Yi46441512006-01-24 16:37:59 +08007094 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007095
7096 if (priv->status & STATUS_ASSOCIATED)
7097 ipw_qos_activate(priv, &(priv->assoc_network->qos_data));
7098
Zhu Yi46441512006-01-24 16:37:59 +08007099 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05007100}
7101
James Ketrenos3b9990c2005-08-19 13:18:55 -05007102static int ipw_handle_probe_response(struct net_device *dev,
7103 struct ieee80211_probe_response *resp,
7104 struct ieee80211_network *network)
James Ketrenosb095c382005-08-24 22:04:42 -05007105{
7106 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos3b9990c2005-08-19 13:18:55 -05007107 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7108 (network == priv->assoc_network));
James Ketrenosb095c382005-08-24 22:04:42 -05007109
James Ketrenos3b9990c2005-08-19 13:18:55 -05007110 ipw_qos_handle_probe_response(priv, active_network, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007111
James Ketrenos3b9990c2005-08-19 13:18:55 -05007112 return 0;
7113}
James Ketrenosb095c382005-08-24 22:04:42 -05007114
James Ketrenos3b9990c2005-08-19 13:18:55 -05007115static int ipw_handle_beacon(struct net_device *dev,
7116 struct ieee80211_beacon *resp,
7117 struct ieee80211_network *network)
7118{
7119 struct ipw_priv *priv = ieee80211_priv(dev);
7120 int active_network = ((priv->status & STATUS_ASSOCIATED) &&
7121 (network == priv->assoc_network));
7122
7123 ipw_qos_handle_probe_response(priv, active_network, network);
7124
7125 return 0;
7126}
7127
7128static int ipw_handle_assoc_response(struct net_device *dev,
7129 struct ieee80211_assoc_response *resp,
7130 struct ieee80211_network *network)
7131{
7132 struct ipw_priv *priv = ieee80211_priv(dev);
7133 ipw_qos_association_resp(priv, network);
James Ketrenosb095c382005-08-24 22:04:42 -05007134 return 0;
7135}
7136
7137static int ipw_send_qos_params_command(struct ipw_priv *priv, struct ieee80211_qos_parameters
7138 *qos_param)
7139{
Zhu Yi4e226992006-01-24 16:37:36 +08007140 return ipw_send_cmd_pdu(priv, IPW_CMD_QOS_PARAMETERS,
7141 sizeof(*qos_param) * 3, qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007142}
7143
7144static int ipw_send_qos_info_command(struct ipw_priv *priv, struct ieee80211_qos_information_element
7145 *qos_param)
7146{
Zhu Yi4e226992006-01-24 16:37:36 +08007147 return ipw_send_cmd_pdu(priv, IPW_CMD_WME_INFO, sizeof(*qos_param),
7148 qos_param);
James Ketrenosb095c382005-08-24 22:04:42 -05007149}
7150
Zhu Yie43e3c12006-04-13 17:20:45 +08007151#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -05007152
James Ketrenos43f66a62005-03-25 12:31:53 -06007153static int ipw_associate_network(struct ipw_priv *priv,
7154 struct ieee80211_network *network,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007155 struct ipw_supported_rates *rates, int roaming)
James Ketrenos43f66a62005-03-25 12:31:53 -06007156{
7157 int err;
7158
7159 if (priv->config & CFG_FIXED_RATE)
James Ketrenosb095c382005-08-24 22:04:42 -05007160 ipw_set_fixed_rate(priv, network->mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06007161
7162 if (!(priv->config & CFG_STATIC_ESSID)) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007163 priv->essid_len = min(network->ssid_len,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007164 (u8) IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06007165 memcpy(priv->essid, network->ssid, priv->essid_len);
7166 }
7167
7168 network->last_associate = jiffies;
7169
7170 memset(&priv->assoc_request, 0, sizeof(priv->assoc_request));
7171 priv->assoc_request.channel = network->channel;
Zhu Yi3e234b42006-01-24 16:36:52 +08007172 priv->assoc_request.auth_key = 0;
7173
James Ketrenos43f66a62005-03-25 12:31:53 -06007174 if ((priv->capability & CAP_PRIVACY_ON) &&
Zhu Yi3e234b42006-01-24 16:36:52 +08007175 (priv->ieee->sec.auth_mode == WLAN_AUTH_SHARED_KEY)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007176 priv->assoc_request.auth_type = AUTH_SHARED_KEY;
James Ketrenosb095c382005-08-24 22:04:42 -05007177 priv->assoc_request.auth_key = priv->ieee->sec.active_key;
7178
Zhu Yi1ba61e02006-02-15 13:00:55 +08007179 if (priv->ieee->sec.level == SEC_LEVEL_1)
James Ketrenosb095c382005-08-24 22:04:42 -05007180 ipw_send_wep_keys(priv, DCW_WEP_KEY_SEC_TYPE_WEP);
Zhu Yi3e234b42006-01-24 16:36:52 +08007181
7182 } else if ((priv->capability & CAP_PRIVACY_ON) &&
7183 (priv->ieee->sec.auth_mode == WLAN_AUTH_LEAP))
7184 priv->assoc_request.auth_type = AUTH_LEAP;
7185 else
James Ketrenos43f66a62005-03-25 12:31:53 -06007186 priv->assoc_request.auth_type = AUTH_OPEN;
James Ketrenos43f66a62005-03-25 12:31:53 -06007187
James Ketrenosa613bff2005-08-24 21:43:11 -05007188 if (priv->ieee->wpa_ie_len) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05007189 priv->assoc_request.policy_support = 0x02; /* RSN active */
7190 ipw_set_rsn_capa(priv, priv->ieee->wpa_ie,
7191 priv->ieee->wpa_ie_len);
7192 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007193
Jeff Garzikbf794512005-07-31 13:07:26 -04007194 /*
7195 * It is valid for our ieee device to support multiple modes, but
7196 * when it comes to associating to a given network we have to choose
James Ketrenos43f66a62005-03-25 12:31:53 -06007197 * just one mode.
7198 */
7199 if (network->mode & priv->ieee->mode & IEEE_A)
7200 priv->assoc_request.ieee_mode = IPW_A_MODE;
7201 else if (network->mode & priv->ieee->mode & IEEE_G)
7202 priv->assoc_request.ieee_mode = IPW_G_MODE;
7203 else if (network->mode & priv->ieee->mode & IEEE_B)
7204 priv->assoc_request.ieee_mode = IPW_B_MODE;
7205
James Ketrenosea2b26e2005-08-24 21:25:16 -05007206 priv->assoc_request.capability = network->capability;
7207 if ((network->capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
7208 && !(priv->config & CFG_PREAMBLE_LONG)) {
7209 priv->assoc_request.preamble_length = DCT_FLAG_SHORT_PREAMBLE;
7210 } else {
7211 priv->assoc_request.preamble_length = DCT_FLAG_LONG_PREAMBLE;
7212
7213 /* Clear the short preamble if we won't be supporting it */
7214 priv->assoc_request.capability &=
7215 ~WLAN_CAPABILITY_SHORT_PREAMBLE;
7216 }
7217
James Ketrenosafbf30a2005-08-25 00:05:33 -05007218 /* Clear capability bits that aren't used in Ad Hoc */
7219 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7220 priv->assoc_request.capability &=
7221 ~WLAN_CAPABILITY_SHORT_SLOT_TIME;
7222
James Ketrenos43f66a62005-03-25 12:31:53 -06007223 IPW_DEBUG_ASSOC("%sssocation attempt: '%s', channel %d, "
James Ketrenosea2b26e2005-08-24 21:25:16 -05007224 "802.11%c [%d], %s[:%s], enc=%s%s%s%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007225 roaming ? "Rea" : "A",
Jeff Garzikbf794512005-07-31 13:07:26 -04007226 escape_essid(priv->essid, priv->essid_len),
7227 network->channel,
7228 ipw_modes[priv->assoc_request.ieee_mode],
7229 rates->num_rates,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007230 (priv->assoc_request.preamble_length ==
7231 DCT_FLAG_LONG_PREAMBLE) ? "long" : "short",
7232 network->capability &
7233 WLAN_CAPABILITY_SHORT_PREAMBLE ? "short" : "long",
James Ketrenos43f66a62005-03-25 12:31:53 -06007234 priv->capability & CAP_PRIVACY_ON ? "on " : "off",
Jeff Garzikbf794512005-07-31 13:07:26 -04007235 priv->capability & CAP_PRIVACY_ON ?
7236 (priv->capability & CAP_SHARED_KEY ? "(shared)" :
James Ketrenos43f66a62005-03-25 12:31:53 -06007237 "(open)") : "",
7238 priv->capability & CAP_PRIVACY_ON ? " key=" : "",
Jeff Garzikbf794512005-07-31 13:07:26 -04007239 priv->capability & CAP_PRIVACY_ON ?
James Ketrenosb095c382005-08-24 22:04:42 -05007240 '1' + priv->ieee->sec.active_key : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007241 priv->capability & CAP_PRIVACY_ON ? '.' : ' ');
James Ketrenos43f66a62005-03-25 12:31:53 -06007242
7243 priv->assoc_request.beacon_interval = network->beacon_interval;
7244 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007245 (network->time_stamp[0] == 0) && (network->time_stamp[1] == 0)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007246 priv->assoc_request.assoc_type = HC_IBSS_START;
7247 priv->assoc_request.assoc_tsf_msw = 0;
7248 priv->assoc_request.assoc_tsf_lsw = 0;
7249 } else {
7250 if (unlikely(roaming))
7251 priv->assoc_request.assoc_type = HC_REASSOCIATE;
7252 else
7253 priv->assoc_request.assoc_type = HC_ASSOCIATE;
7254 priv->assoc_request.assoc_tsf_msw = network->time_stamp[1];
7255 priv->assoc_request.assoc_tsf_lsw = network->time_stamp[0];
7256 }
7257
James Ketrenosafbf30a2005-08-25 00:05:33 -05007258 memcpy(priv->assoc_request.bssid, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007259
7260 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
7261 memset(&priv->assoc_request.dest, 0xFF, ETH_ALEN);
7262 priv->assoc_request.atim_window = network->atim_window;
7263 } else {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007264 memcpy(priv->assoc_request.dest, network->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06007265 priv->assoc_request.atim_window = 0;
7266 }
7267
James Ketrenos43f66a62005-03-25 12:31:53 -06007268 priv->assoc_request.listen_interval = network->listen_interval;
Jeff Garzikbf794512005-07-31 13:07:26 -04007269
James Ketrenos43f66a62005-03-25 12:31:53 -06007270 err = ipw_send_ssid(priv, priv->essid, priv->essid_len);
7271 if (err) {
7272 IPW_DEBUG_HC("Attempt to send SSID command failed.\n");
7273 return err;
7274 }
7275
7276 rates->ieee_mode = priv->assoc_request.ieee_mode;
7277 rates->purpose = IPW_RATE_CONNECT;
7278 ipw_send_supported_rates(priv, rates);
Jeff Garzikbf794512005-07-31 13:07:26 -04007279
James Ketrenos43f66a62005-03-25 12:31:53 -06007280 if (priv->assoc_request.ieee_mode == IPW_G_MODE)
7281 priv->sys_config.dot11g_auto_detection = 1;
7282 else
7283 priv->sys_config.dot11g_auto_detection = 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05007284
7285 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
7286 priv->sys_config.answer_broadcast_ssid_probe = 1;
7287 else
7288 priv->sys_config.answer_broadcast_ssid_probe = 0;
7289
Zhu Yid685b8c2006-04-13 17:20:27 +08007290 err = ipw_send_system_config(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06007291 if (err) {
7292 IPW_DEBUG_HC("Attempt to send sys config command failed.\n");
7293 return err;
7294 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007295
James Ketrenos43f66a62005-03-25 12:31:53 -06007296 IPW_DEBUG_ASSOC("Association sensitivity: %d\n", network->stats.rssi);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007297 err = ipw_set_sensitivity(priv, network->stats.rssi + IPW_RSSI_TO_DBM);
James Ketrenos43f66a62005-03-25 12:31:53 -06007298 if (err) {
7299 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7300 return err;
7301 }
7302
7303 /*
7304 * If preemption is enabled, it is possible for the association
7305 * to complete before we return from ipw_send_associate. Therefore
7306 * we have to be sure and update our priviate data first.
7307 */
7308 priv->channel = network->channel;
7309 memcpy(priv->bssid, network->bssid, ETH_ALEN);
Jeff Garzikbf794512005-07-31 13:07:26 -04007310 priv->status |= STATUS_ASSOCIATING;
James Ketrenos43f66a62005-03-25 12:31:53 -06007311 priv->status &= ~STATUS_SECURITY_UPDATED;
7312
7313 priv->assoc_network = network;
7314
Zhu Yie43e3c12006-04-13 17:20:45 +08007315#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -05007316 ipw_qos_association(priv, network);
7317#endif
7318
James Ketrenos43f66a62005-03-25 12:31:53 -06007319 err = ipw_send_associate(priv, &priv->assoc_request);
7320 if (err) {
7321 IPW_DEBUG_HC("Attempt to send associate command failed.\n");
7322 return err;
7323 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007324
7325 IPW_DEBUG(IPW_DL_STATE, "associating: '%s' " MAC_FMT " \n",
James Ketrenos43f66a62005-03-25 12:31:53 -06007326 escape_essid(priv->essid, priv->essid_len),
7327 MAC_ARG(priv->bssid));
7328
7329 return 0;
7330}
7331
7332static void ipw_roam(void *data)
7333{
7334 struct ipw_priv *priv = data;
7335 struct ieee80211_network *network = NULL;
7336 struct ipw_network_match match = {
7337 .network = priv->assoc_network
7338 };
7339
7340 /* The roaming process is as follows:
Jeff Garzikbf794512005-07-31 13:07:26 -04007341 *
7342 * 1. Missed beacon threshold triggers the roaming process by
James Ketrenos43f66a62005-03-25 12:31:53 -06007343 * setting the status ROAM bit and requesting a scan.
7344 * 2. When the scan completes, it schedules the ROAM work
7345 * 3. The ROAM work looks at all of the known networks for one that
7346 * is a better network than the currently associated. If none
7347 * found, the ROAM process is over (ROAM bit cleared)
7348 * 4. If a better network is found, a disassociation request is
7349 * sent.
7350 * 5. When the disassociation completes, the roam work is again
7351 * scheduled. The second time through, the driver is no longer
7352 * associated, and the newly selected network is sent an
Jeff Garzikbf794512005-07-31 13:07:26 -04007353 * association request.
James Ketrenos43f66a62005-03-25 12:31:53 -06007354 * 6. At this point ,the roaming process is complete and the ROAM
7355 * status bit is cleared.
7356 */
7357
7358 /* If we are no longer associated, and the roaming bit is no longer
7359 * set, then we are not actively roaming, so just return */
7360 if (!(priv->status & (STATUS_ASSOCIATED | STATUS_ROAMING)))
7361 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007362
James Ketrenos43f66a62005-03-25 12:31:53 -06007363 if (priv->status & STATUS_ASSOCIATED) {
Jeff Garzikbf794512005-07-31 13:07:26 -04007364 /* First pass through ROAM process -- look for a better
James Ketrenos43f66a62005-03-25 12:31:53 -06007365 * network */
James Ketrenosa613bff2005-08-24 21:43:11 -05007366 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007367 u8 rssi = priv->assoc_network->stats.rssi;
7368 priv->assoc_network->stats.rssi = -128;
James Ketrenosa613bff2005-08-24 21:43:11 -05007369 spin_lock_irqsave(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007370 list_for_each_entry(network, &priv->ieee->network_list, list) {
7371 if (network != priv->assoc_network)
7372 ipw_best_network(priv, &match, network, 1);
7373 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007374 spin_unlock_irqrestore(&priv->ieee->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -06007375 priv->assoc_network->stats.rssi = rssi;
Jeff Garzikbf794512005-07-31 13:07:26 -04007376
James Ketrenos43f66a62005-03-25 12:31:53 -06007377 if (match.network == priv->assoc_network) {
7378 IPW_DEBUG_ASSOC("No better APs in this network to "
7379 "roam to.\n");
7380 priv->status &= ~STATUS_ROAMING;
7381 ipw_debug_config(priv);
7382 return;
7383 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007384
James Ketrenos43f66a62005-03-25 12:31:53 -06007385 ipw_send_disassociate(priv, 1);
7386 priv->assoc_network = match.network;
7387
7388 return;
Jeff Garzikbf794512005-07-31 13:07:26 -04007389 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007390
7391 /* Second pass through ROAM process -- request association */
7392 ipw_compatible_rates(priv, priv->assoc_network, &match.rates);
7393 ipw_associate_network(priv, priv->assoc_network, &match.rates, 1);
7394 priv->status &= ~STATUS_ROAMING;
7395}
7396
James Ketrenosc848d0a2005-08-24 21:56:24 -05007397static void ipw_bg_roam(void *data)
7398{
7399 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08007400 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007401 ipw_roam(data);
Zhu Yi46441512006-01-24 16:37:59 +08007402 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007403}
7404
7405static int ipw_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007406{
7407 struct ipw_priv *priv = data;
7408
7409 struct ieee80211_network *network = NULL;
7410 struct ipw_network_match match = {
7411 .network = NULL
7412 };
7413 struct ipw_supported_rates *rates;
7414 struct list_head *element;
James Ketrenosa613bff2005-08-24 21:43:11 -05007415 unsigned long flags;
James Ketrenos43f66a62005-03-25 12:31:53 -06007416
James Ketrenosb095c382005-08-24 22:04:42 -05007417 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
7418 IPW_DEBUG_ASSOC("Not attempting association (monitor mode)\n");
7419 return 0;
7420 }
7421
James Ketrenosc848d0a2005-08-24 21:56:24 -05007422 if (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007423 IPW_DEBUG_ASSOC("Not attempting association (already in "
7424 "progress)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007425 return 0;
7426 }
7427
Hong Liue6324722005-09-14 21:04:15 -05007428 if (priv->status & STATUS_DISASSOCIATING) {
7429 IPW_DEBUG_ASSOC("Not attempting association (in "
7430 "disassociating)\n ");
7431 queue_work(priv->workqueue, &priv->associate);
7432 return 0;
7433 }
7434
James Ketrenosc848d0a2005-08-24 21:56:24 -05007435 if (!ipw_is_init(priv) || (priv->status & STATUS_SCANNING)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05007436 IPW_DEBUG_ASSOC("Not attempting association (scanning or not "
7437 "initialized)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007438 return 0;
7439 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007440
7441 if (!(priv->config & CFG_ASSOCIATE) &&
7442 !(priv->config & (CFG_STATIC_ESSID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007443 CFG_STATIC_CHANNEL | CFG_STATIC_BSSID))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06007444 IPW_DEBUG_ASSOC("Not attempting association (associate=0)\n");
James Ketrenosc848d0a2005-08-24 21:56:24 -05007445 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007446 }
7447
James Ketrenosa613bff2005-08-24 21:43:11 -05007448 /* Protect our use of the network_list */
7449 spin_lock_irqsave(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007450 list_for_each_entry(network, &priv->ieee->network_list, list)
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007451 ipw_best_network(priv, &match, network, 0);
James Ketrenos43f66a62005-03-25 12:31:53 -06007452
7453 network = match.network;
7454 rates = &match.rates;
7455
7456 if (network == NULL &&
7457 priv->ieee->iw_mode == IW_MODE_ADHOC &&
7458 priv->config & CFG_ADHOC_CREATE &&
7459 priv->config & CFG_STATIC_ESSID &&
James Ketrenosa613bff2005-08-24 21:43:11 -05007460 priv->config & CFG_STATIC_CHANNEL &&
James Ketrenos43f66a62005-03-25 12:31:53 -06007461 !list_empty(&priv->ieee->network_free_list)) {
7462 element = priv->ieee->network_free_list.next;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04007463 network = list_entry(element, struct ieee80211_network, list);
James Ketrenos43f66a62005-03-25 12:31:53 -06007464 ipw_adhoc_create(priv, network);
7465 rates = &priv->rates;
7466 list_del(element);
7467 list_add_tail(&network->list, &priv->ieee->network_list);
7468 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007469 spin_unlock_irqrestore(&priv->ieee->lock, flags);
Jeff Garzikbf794512005-07-31 13:07:26 -04007470
James Ketrenos43f66a62005-03-25 12:31:53 -06007471 /* If we reached the end of the list, then we don't have any valid
7472 * matching APs */
7473 if (!network) {
7474 ipw_debug_config(priv);
7475
James Ketrenosb095c382005-08-24 22:04:42 -05007476 if (!(priv->status & STATUS_SCANNING)) {
7477 if (!(priv->config & CFG_SPEED_SCAN))
7478 queue_delayed_work(priv->workqueue,
7479 &priv->request_scan,
7480 SCAN_INTERVAL);
7481 else
7482 queue_work(priv->workqueue,
7483 &priv->request_scan);
7484 }
Jeff Garzikbf794512005-07-31 13:07:26 -04007485
James Ketrenosc848d0a2005-08-24 21:56:24 -05007486 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06007487 }
7488
7489 ipw_associate_network(priv, network, rates, 0);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007490
7491 return 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06007492}
Jeff Garzikbf794512005-07-31 13:07:26 -04007493
James Ketrenosc848d0a2005-08-24 21:56:24 -05007494static void ipw_bg_associate(void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -06007495{
James Ketrenosc848d0a2005-08-24 21:56:24 -05007496 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +08007497 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05007498 ipw_associate(data);
Zhu Yi46441512006-01-24 16:37:59 +08007499 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06007500}
7501
James Ketrenosb095c382005-08-24 22:04:42 -05007502static void ipw_rebuild_decrypted_skb(struct ipw_priv *priv,
7503 struct sk_buff *skb)
7504{
7505 struct ieee80211_hdr *hdr;
7506 u16 fc;
7507
7508 hdr = (struct ieee80211_hdr *)skb->data;
7509 fc = le16_to_cpu(hdr->frame_ctl);
7510 if (!(fc & IEEE80211_FCTL_PROTECTED))
7511 return;
7512
7513 fc &= ~IEEE80211_FCTL_PROTECTED;
7514 hdr->frame_ctl = cpu_to_le16(fc);
7515 switch (priv->ieee->sec.level) {
7516 case SEC_LEVEL_3:
7517 /* Remove CCMP HDR */
7518 memmove(skb->data + IEEE80211_3ADDR_LEN,
7519 skb->data + IEEE80211_3ADDR_LEN + 8,
7520 skb->len - IEEE80211_3ADDR_LEN - 8);
Zhu Yif4ff4972005-09-12 10:48:48 -05007521 skb_trim(skb, skb->len - 16); /* CCMP_HDR_LEN + CCMP_MIC_LEN */
James Ketrenosb095c382005-08-24 22:04:42 -05007522 break;
7523 case SEC_LEVEL_2:
7524 break;
7525 case SEC_LEVEL_1:
7526 /* Remove IV */
7527 memmove(skb->data + IEEE80211_3ADDR_LEN,
7528 skb->data + IEEE80211_3ADDR_LEN + 4,
7529 skb->len - IEEE80211_3ADDR_LEN - 4);
Zhu Yif4ff4972005-09-12 10:48:48 -05007530 skb_trim(skb, skb->len - 8); /* IV + ICV */
James Ketrenosb095c382005-08-24 22:04:42 -05007531 break;
7532 case SEC_LEVEL_0:
7533 break;
7534 default:
7535 printk(KERN_ERR "Unknow security level %d\n",
7536 priv->ieee->sec.level);
7537 break;
7538 }
7539}
7540
7541static void ipw_handle_data_packet(struct ipw_priv *priv,
7542 struct ipw_rx_mem_buffer *rxb,
7543 struct ieee80211_rx_stats *stats)
James Ketrenos43f66a62005-03-25 12:31:53 -06007544{
Hong Liu567deaf2005-08-31 18:07:22 +08007545 struct ieee80211_hdr_4addr *hdr;
James Ketrenos43f66a62005-03-25 12:31:53 -06007546 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7547
7548 /* We received data from the HW, so stop the watchdog */
7549 priv->net_dev->trans_start = jiffies;
7550
Jeff Garzikbf794512005-07-31 13:07:26 -04007551 /* We only process data packets if the
James Ketrenos43f66a62005-03-25 12:31:53 -06007552 * interface is open */
James Ketrenosa613bff2005-08-24 21:43:11 -05007553 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
James Ketrenos43f66a62005-03-25 12:31:53 -06007554 skb_tailroom(rxb->skb))) {
7555 priv->ieee->stats.rx_errors++;
7556 priv->wstats.discard.misc++;
7557 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7558 return;
7559 } else if (unlikely(!netif_running(priv->net_dev))) {
7560 priv->ieee->stats.rx_dropped++;
7561 priv->wstats.discard.misc++;
7562 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7563 return;
7564 }
7565
7566 /* Advance skb->data to the start of the actual payload */
Jiri Bencaaa4d302005-06-07 14:58:41 +02007567 skb_reserve(rxb->skb, offsetof(struct ipw_rx_packet, u.frame.data));
James Ketrenos43f66a62005-03-25 12:31:53 -06007568
7569 /* Set the size of the skb to the size of the frame */
James Ketrenosa613bff2005-08-24 21:43:11 -05007570 skb_put(rxb->skb, le16_to_cpu(pkt->u.frame.length));
James Ketrenos43f66a62005-03-25 12:31:53 -06007571
7572 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7573
James Ketrenosb095c382005-08-24 22:04:42 -05007574 /* HW decrypt will not clear the WEP bit, MIC, PN, etc. */
Hong Liu567deaf2005-08-31 18:07:22 +08007575 hdr = (struct ieee80211_hdr_4addr *)rxb->skb->data;
7576 if (priv->ieee->iw_mode != IW_MODE_MONITOR &&
Stephen Hemminger3c190652006-01-03 15:27:38 -08007577 (is_multicast_ether_addr(hdr->addr1) ?
Hong Liu567deaf2005-08-31 18:07:22 +08007578 !priv->ieee->host_mc_decrypt : !priv->ieee->host_decrypt))
James Ketrenosb095c382005-08-24 22:04:42 -05007579 ipw_rebuild_decrypted_skb(priv, rxb->skb);
7580
Jeff Garzikbf794512005-07-31 13:07:26 -04007581 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
James Ketrenos43f66a62005-03-25 12:31:53 -06007582 priv->ieee->stats.rx_errors++;
James Ketrenosa613bff2005-08-24 21:43:11 -05007583 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007584 rxb->skb = NULL;
James Ketrenosb095c382005-08-24 22:04:42 -05007585 __ipw_led_activity_on(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -05007586 }
James Ketrenos43f66a62005-03-25 12:31:53 -06007587}
7588
Zhu Yi459d4082006-04-13 17:21:00 +08007589#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05007590static void ipw_handle_data_packet_monitor(struct ipw_priv *priv,
7591 struct ipw_rx_mem_buffer *rxb,
7592 struct ieee80211_rx_stats *stats)
7593{
7594 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7595 struct ipw_rx_frame *frame = &pkt->u.frame;
7596
7597 /* initial pull of some data */
7598 u16 received_channel = frame->received_channel;
7599 u8 antennaAndPhy = frame->antennaAndPhy;
7600 s8 antsignal = frame->rssi_dbm - IPW_RSSI_TO_DBM; /* call it signed anyhow */
7601 u16 pktrate = frame->rate;
7602
7603 /* Magic struct that slots into the radiotap header -- no reason
7604 * to build this manually element by element, we can write it much
7605 * more efficiently than we can parse it. ORDER MATTERS HERE */
Zhu Yid685b8c2006-04-13 17:20:27 +08007606 struct ipw_rt_hdr *ipw_rt;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007607
7608 short len = le16_to_cpu(pkt->u.frame.length);
7609
7610 /* We received data from the HW, so stop the watchdog */
7611 priv->net_dev->trans_start = jiffies;
7612
7613 /* We only process data packets if the
7614 * interface is open */
7615 if (unlikely((le16_to_cpu(pkt->u.frame.length) + IPW_RX_FRAME_SIZE) >
7616 skb_tailroom(rxb->skb))) {
7617 priv->ieee->stats.rx_errors++;
7618 priv->wstats.discard.misc++;
7619 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7620 return;
7621 } else if (unlikely(!netif_running(priv->net_dev))) {
7622 priv->ieee->stats.rx_dropped++;
7623 priv->wstats.discard.misc++;
7624 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7625 return;
7626 }
7627
7628 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7629 * that now */
7630 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7631 /* FIXME: Should alloc bigger skb instead */
7632 priv->ieee->stats.rx_dropped++;
7633 priv->wstats.discard.misc++;
7634 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7635 return;
7636 }
7637
7638 /* copy the frame itself */
7639 memmove(rxb->skb->data + sizeof(struct ipw_rt_hdr),
7640 rxb->skb->data + IPW_RX_FRAME_SIZE, len);
7641
7642 /* Zero the radiotap static buffer ... We only need to zero the bytes NOT
7643 * part of our real header, saves a little time.
7644 *
7645 * No longer necessary since we fill in all our data. Purge before merging
7646 * patch officially.
7647 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7648 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7649 */
7650
7651 ipw_rt = (struct ipw_rt_hdr *)rxb->skb->data;
7652
7653 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7654 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7655 ipw_rt->rt_hdr.it_len = sizeof(struct ipw_rt_hdr); /* total header+data */
7656
7657 /* Big bitfield of all the fields we provide in radiotap */
7658 ipw_rt->rt_hdr.it_present =
7659 ((1 << IEEE80211_RADIOTAP_FLAGS) |
7660 (1 << IEEE80211_RADIOTAP_RATE) |
7661 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7662 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007663 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
Mike Kershaw24a47db2005-08-26 00:41:54 -05007664 (1 << IEEE80211_RADIOTAP_ANTENNA));
7665
7666 /* Zero the flags, we'll add to them as we go */
7667 ipw_rt->rt_flags = 0;
Zhu Yi88a93df2006-08-21 11:38:08 +08007668 ipw_rt->rt_tsf = 0ULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007669
7670 /* Convert signal to DBM */
7671 ipw_rt->rt_dbmsignal = antsignal;
7672
7673 /* Convert the channel data and set the flags */
7674 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(received_channel));
7675 if (received_channel > 14) { /* 802.11a */
7676 ipw_rt->rt_chbitmask =
7677 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7678 } else if (antennaAndPhy & 32) { /* 802.11b */
7679 ipw_rt->rt_chbitmask =
7680 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7681 } else { /* 802.11g */
7682 ipw_rt->rt_chbitmask =
7683 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7684 }
7685
7686 /* set the rate in multiples of 500k/s */
7687 switch (pktrate) {
7688 case IPW_TX_RATE_1MB:
7689 ipw_rt->rt_rate = 2;
7690 break;
7691 case IPW_TX_RATE_2MB:
7692 ipw_rt->rt_rate = 4;
7693 break;
7694 case IPW_TX_RATE_5MB:
7695 ipw_rt->rt_rate = 10;
7696 break;
7697 case IPW_TX_RATE_6MB:
7698 ipw_rt->rt_rate = 12;
7699 break;
7700 case IPW_TX_RATE_9MB:
7701 ipw_rt->rt_rate = 18;
7702 break;
7703 case IPW_TX_RATE_11MB:
7704 ipw_rt->rt_rate = 22;
7705 break;
7706 case IPW_TX_RATE_12MB:
7707 ipw_rt->rt_rate = 24;
7708 break;
7709 case IPW_TX_RATE_18MB:
7710 ipw_rt->rt_rate = 36;
7711 break;
7712 case IPW_TX_RATE_24MB:
7713 ipw_rt->rt_rate = 48;
7714 break;
7715 case IPW_TX_RATE_36MB:
7716 ipw_rt->rt_rate = 72;
7717 break;
7718 case IPW_TX_RATE_48MB:
7719 ipw_rt->rt_rate = 96;
7720 break;
7721 case IPW_TX_RATE_54MB:
7722 ipw_rt->rt_rate = 108;
7723 break;
7724 default:
7725 ipw_rt->rt_rate = 0;
7726 break;
7727 }
7728
7729 /* antenna number */
7730 ipw_rt->rt_antenna = (antennaAndPhy & 3); /* Is this right? */
7731
7732 /* set the preamble flag if we have it */
7733 if ((antennaAndPhy & 64))
7734 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7735
7736 /* Set the size of the skb to the size of the frame */
7737 skb_put(rxb->skb, len + sizeof(struct ipw_rt_hdr));
James Ketrenos43f66a62005-03-25 12:31:53 -06007738
7739 IPW_DEBUG_RX("Rx packet of %d bytes.\n", rxb->skb->len);
7740
7741 if (!ieee80211_rx(priv->ieee, rxb->skb, stats))
7742 priv->ieee->stats.rx_errors++;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007743 else { /* ieee80211_rx succeeded, so it now owns the SKB */
James Ketrenos43f66a62005-03-25 12:31:53 -06007744 rxb->skb = NULL;
Mike Kershaw24a47db2005-08-26 00:41:54 -05007745 /* no LED during capture */
7746 }
7747}
7748#endif
7749
Zhu Yid685b8c2006-04-13 17:20:27 +08007750#ifdef CONFIG_IPW2200_PROMISCUOUS
7751#define ieee80211_is_probe_response(fc) \
7752 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT && \
7753 (fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PROBE_RESP )
7754
7755#define ieee80211_is_management(fc) \
7756 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_MGMT)
7757
7758#define ieee80211_is_control(fc) \
7759 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_CTL)
7760
7761#define ieee80211_is_data(fc) \
7762 ((fc & IEEE80211_FCTL_FTYPE) == IEEE80211_FTYPE_DATA)
7763
7764#define ieee80211_is_assoc_request(fc) \
7765 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_ASSOC_REQ)
7766
7767#define ieee80211_is_reassoc_request(fc) \
7768 ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_REASSOC_REQ)
7769
7770static void ipw_handle_promiscuous_rx(struct ipw_priv *priv,
7771 struct ipw_rx_mem_buffer *rxb,
7772 struct ieee80211_rx_stats *stats)
7773{
7774 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)rxb->skb->data;
7775 struct ipw_rx_frame *frame = &pkt->u.frame;
7776 struct ipw_rt_hdr *ipw_rt;
7777
7778 /* First cache any information we need before we overwrite
7779 * the information provided in the skb from the hardware */
7780 struct ieee80211_hdr *hdr;
7781 u16 channel = frame->received_channel;
7782 u8 phy_flags = frame->antennaAndPhy;
7783 s8 signal = frame->rssi_dbm - IPW_RSSI_TO_DBM;
7784 s8 noise = frame->noise;
7785 u8 rate = frame->rate;
7786 short len = le16_to_cpu(pkt->u.frame.length);
Zhu Yid685b8c2006-04-13 17:20:27 +08007787 struct sk_buff *skb;
7788 int hdr_only = 0;
7789 u16 filter = priv->prom_priv->filter;
7790
7791 /* If the filter is set to not include Rx frames then return */
7792 if (filter & IPW_PROM_NO_RX)
7793 return;
7794
Zhu Yid685b8c2006-04-13 17:20:27 +08007795 /* We received data from the HW, so stop the watchdog */
7796 priv->prom_net_dev->trans_start = jiffies;
7797
7798 if (unlikely((len + IPW_RX_FRAME_SIZE) > skb_tailroom(rxb->skb))) {
7799 priv->prom_priv->ieee->stats.rx_errors++;
7800 IPW_DEBUG_DROP("Corruption detected! Oh no!\n");
7801 return;
7802 }
7803
7804 /* We only process data packets if the interface is open */
7805 if (unlikely(!netif_running(priv->prom_net_dev))) {
7806 priv->prom_priv->ieee->stats.rx_dropped++;
7807 IPW_DEBUG_DROP("Dropping packet while interface is not up.\n");
7808 return;
7809 }
7810
7811 /* Libpcap 0.9.3+ can handle variable length radiotap, so we'll use
7812 * that now */
7813 if (len > IPW_RX_BUF_SIZE - sizeof(struct ipw_rt_hdr)) {
7814 /* FIXME: Should alloc bigger skb instead */
7815 priv->prom_priv->ieee->stats.rx_dropped++;
7816 IPW_DEBUG_DROP("Dropping too large packet in monitor\n");
7817 return;
7818 }
7819
7820 hdr = (void *)rxb->skb->data + IPW_RX_FRAME_SIZE;
Zhu Yi851ca262006-08-21 11:37:58 +08007821 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007822 if (filter & IPW_PROM_NO_MGMT)
7823 return;
7824 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
7825 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007826 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007827 if (filter & IPW_PROM_NO_CTL)
7828 return;
7829 if (filter & IPW_PROM_CTL_HEADER_ONLY)
7830 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +08007831 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +08007832 if (filter & IPW_PROM_NO_DATA)
7833 return;
7834 if (filter & IPW_PROM_DATA_HEADER_ONLY)
7835 hdr_only = 1;
7836 }
7837
7838 /* Copy the SKB since this is for the promiscuous side */
7839 skb = skb_copy(rxb->skb, GFP_ATOMIC);
7840 if (skb == NULL) {
7841 IPW_ERROR("skb_clone failed for promiscuous copy.\n");
7842 return;
7843 }
7844
7845 /* copy the frame data to write after where the radiotap header goes */
7846 ipw_rt = (void *)skb->data;
7847
7848 if (hdr_only)
Zhu Yi851ca262006-08-21 11:37:58 +08007849 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +08007850
7851 memcpy(ipw_rt->payload, hdr, len);
7852
7853 /* Zero the radiotap static buffer ... We only need to zero the bytes
7854 * NOT part of our real header, saves a little time.
7855 *
7856 * No longer necessary since we fill in all our data. Purge before
7857 * merging patch officially.
7858 * memset(rxb->skb->data + sizeof(struct ipw_rt_hdr), 0,
7859 * IEEE80211_RADIOTAP_HDRLEN - sizeof(struct ipw_rt_hdr));
7860 */
7861
7862 ipw_rt->rt_hdr.it_version = PKTHDR_RADIOTAP_VERSION;
7863 ipw_rt->rt_hdr.it_pad = 0; /* always good to zero */
7864 ipw_rt->rt_hdr.it_len = sizeof(*ipw_rt); /* total header+data */
7865
7866 /* Set the size of the skb to the size of the frame */
7867 skb_put(skb, ipw_rt->rt_hdr.it_len + len);
7868
7869 /* Big bitfield of all the fields we provide in radiotap */
7870 ipw_rt->rt_hdr.it_present =
7871 ((1 << IEEE80211_RADIOTAP_FLAGS) |
Zhu Yid685b8c2006-04-13 17:20:27 +08007872 (1 << IEEE80211_RADIOTAP_RATE) |
7873 (1 << IEEE80211_RADIOTAP_CHANNEL) |
7874 (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL) |
7875 (1 << IEEE80211_RADIOTAP_DBM_ANTNOISE) |
7876 (1 << IEEE80211_RADIOTAP_ANTENNA));
7877
7878 /* Zero the flags, we'll add to them as we go */
7879 ipw_rt->rt_flags = 0;
Zhu Yi88a93df2006-08-21 11:38:08 +08007880 ipw_rt->rt_tsf = 0ULL;
Zhu Yid685b8c2006-04-13 17:20:27 +08007881
7882 /* Convert to DBM */
7883 ipw_rt->rt_dbmsignal = signal;
7884 ipw_rt->rt_dbmnoise = noise;
7885
7886 /* Convert the channel data and set the flags */
7887 ipw_rt->rt_channel = cpu_to_le16(ieee80211chan2mhz(channel));
7888 if (channel > 14) { /* 802.11a */
7889 ipw_rt->rt_chbitmask =
7890 cpu_to_le16((IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ));
7891 } else if (phy_flags & (1 << 5)) { /* 802.11b */
7892 ipw_rt->rt_chbitmask =
7893 cpu_to_le16((IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ));
7894 } else { /* 802.11g */
7895 ipw_rt->rt_chbitmask =
7896 (IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ);
7897 }
7898
7899 /* set the rate in multiples of 500k/s */
7900 switch (rate) {
7901 case IPW_TX_RATE_1MB:
7902 ipw_rt->rt_rate = 2;
7903 break;
7904 case IPW_TX_RATE_2MB:
7905 ipw_rt->rt_rate = 4;
7906 break;
7907 case IPW_TX_RATE_5MB:
7908 ipw_rt->rt_rate = 10;
7909 break;
7910 case IPW_TX_RATE_6MB:
7911 ipw_rt->rt_rate = 12;
7912 break;
7913 case IPW_TX_RATE_9MB:
7914 ipw_rt->rt_rate = 18;
7915 break;
7916 case IPW_TX_RATE_11MB:
7917 ipw_rt->rt_rate = 22;
7918 break;
7919 case IPW_TX_RATE_12MB:
7920 ipw_rt->rt_rate = 24;
7921 break;
7922 case IPW_TX_RATE_18MB:
7923 ipw_rt->rt_rate = 36;
7924 break;
7925 case IPW_TX_RATE_24MB:
7926 ipw_rt->rt_rate = 48;
7927 break;
7928 case IPW_TX_RATE_36MB:
7929 ipw_rt->rt_rate = 72;
7930 break;
7931 case IPW_TX_RATE_48MB:
7932 ipw_rt->rt_rate = 96;
7933 break;
7934 case IPW_TX_RATE_54MB:
7935 ipw_rt->rt_rate = 108;
7936 break;
7937 default:
7938 ipw_rt->rt_rate = 0;
7939 break;
7940 }
7941
7942 /* antenna number */
7943 ipw_rt->rt_antenna = (phy_flags & 3);
7944
7945 /* set the preamble flag if we have it */
7946 if (phy_flags & (1 << 6))
7947 ipw_rt->rt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
7948
7949 IPW_DEBUG_RX("Rx packet of %d bytes.\n", skb->len);
7950
7951 if (!ieee80211_rx(priv->prom_priv->ieee, skb, stats)) {
7952 priv->prom_priv->ieee->stats.rx_errors++;
7953 dev_kfree_skb_any(skb);
7954 }
7955}
7956#endif
7957
Arjan van de Ven858119e2006-01-14 13:20:43 -08007958static int is_network_packet(struct ipw_priv *priv,
James Ketrenosea2b26e2005-08-24 21:25:16 -05007959 struct ieee80211_hdr_4addr *header)
7960{
7961 /* Filter incoming packets to determine if they are targetted toward
7962 * this network, discarding packets coming from ourselves */
7963 switch (priv->ieee->iw_mode) {
James Ketrenosa613bff2005-08-24 21:43:11 -05007964 case IW_MODE_ADHOC: /* Header: Dest. | Source | BSSID */
James Ketrenosc848d0a2005-08-24 21:56:24 -05007965 /* packets from our adapter are dropped (echo) */
7966 if (!memcmp(header->addr2, priv->net_dev->dev_addr, ETH_ALEN))
7967 return 0;
7968
Peter Jones90700fd2005-08-26 16:51:06 -05007969 /* {broad,multi}cast packets to our BSSID go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08007970 if (is_multicast_ether_addr(header->addr1))
James Ketrenosea2b26e2005-08-24 21:25:16 -05007971 return !memcmp(header->addr3, priv->bssid, ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05007972
7973 /* packets to our adapter go through */
7974 return !memcmp(header->addr1, priv->net_dev->dev_addr,
7975 ETH_ALEN);
James Ketrenosa613bff2005-08-24 21:43:11 -05007976
Peter Jones90700fd2005-08-26 16:51:06 -05007977 case IW_MODE_INFRA: /* Header: Dest. | BSSID | Source */
James Ketrenosc848d0a2005-08-24 21:56:24 -05007978 /* packets from our adapter are dropped (echo) */
7979 if (!memcmp(header->addr3, priv->net_dev->dev_addr, ETH_ALEN))
7980 return 0;
7981
Peter Jones90700fd2005-08-26 16:51:06 -05007982 /* {broad,multi}cast packets to our BSS go through */
Stephen Hemminger3c190652006-01-03 15:27:38 -08007983 if (is_multicast_ether_addr(header->addr1))
James Ketrenosa613bff2005-08-24 21:43:11 -05007984 return !memcmp(header->addr2, priv->bssid, ETH_ALEN);
7985
7986 /* packets to our adapter go through */
7987 return !memcmp(header->addr1, priv->net_dev->dev_addr,
7988 ETH_ALEN);
James Ketrenosea2b26e2005-08-24 21:25:16 -05007989 }
James Ketrenosa613bff2005-08-24 21:43:11 -05007990
James Ketrenosea2b26e2005-08-24 21:25:16 -05007991 return 1;
7992}
7993
James Ketrenosafbf30a2005-08-25 00:05:33 -05007994#define IPW_PACKET_RETRY_TIME HZ
7995
Arjan van de Ven858119e2006-01-14 13:20:43 -08007996static int is_duplicate_packet(struct ipw_priv *priv,
James Ketrenosafbf30a2005-08-25 00:05:33 -05007997 struct ieee80211_hdr_4addr *header)
7998{
James Ketrenosafbf30a2005-08-25 00:05:33 -05007999 u16 sc = le16_to_cpu(header->seq_ctl);
8000 u16 seq = WLAN_GET_SEQ_SEQ(sc);
8001 u16 frag = WLAN_GET_SEQ_FRAG(sc);
8002 u16 *last_seq, *last_frag;
8003 unsigned long *last_time;
8004
8005 switch (priv->ieee->iw_mode) {
8006 case IW_MODE_ADHOC:
8007 {
8008 struct list_head *p;
8009 struct ipw_ibss_seq *entry = NULL;
8010 u8 *mac = header->addr2;
8011 int index = mac[5] % IPW_IBSS_MAC_HASH_SIZE;
8012
8013 __list_for_each(p, &priv->ibss_mac_hash[index]) {
8014 entry =
8015 list_entry(p, struct ipw_ibss_seq, list);
8016 if (!memcmp(entry->mac, mac, ETH_ALEN))
8017 break;
8018 }
8019 if (p == &priv->ibss_mac_hash[index]) {
8020 entry = kmalloc(sizeof(*entry), GFP_ATOMIC);
8021 if (!entry) {
8022 IPW_ERROR
8023 ("Cannot malloc new mac entry\n");
8024 return 0;
8025 }
8026 memcpy(entry->mac, mac, ETH_ALEN);
8027 entry->seq_num = seq;
8028 entry->frag_num = frag;
8029 entry->packet_time = jiffies;
8030 list_add(&entry->list,
8031 &priv->ibss_mac_hash[index]);
8032 return 0;
8033 }
8034 last_seq = &entry->seq_num;
8035 last_frag = &entry->frag_num;
8036 last_time = &entry->packet_time;
8037 break;
8038 }
8039 case IW_MODE_INFRA:
8040 last_seq = &priv->last_seq_num;
8041 last_frag = &priv->last_frag_num;
8042 last_time = &priv->last_packet_time;
8043 break;
8044 default:
8045 return 0;
8046 }
8047 if ((*last_seq == seq) &&
8048 time_after(*last_time + IPW_PACKET_RETRY_TIME, jiffies)) {
8049 if (*last_frag == frag)
8050 goto drop;
8051 if (*last_frag + 1 != frag)
8052 /* out-of-order fragment */
8053 goto drop;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008054 } else
8055 *last_seq = seq;
8056
Zhu Yif57ce7c2005-07-13 12:22:15 -05008057 *last_frag = frag;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008058 *last_time = jiffies;
8059 return 0;
8060
8061 drop:
Zhu Yi87b016c2005-08-05 17:17:35 +08008062 /* Comment this line now since we observed the card receives
8063 * duplicate packets but the FCTL_RETRY bit is not set in the
8064 * IBSS mode with fragmentation enabled.
8065 BUG_ON(!(le16_to_cpu(header->frame_ctl) & IEEE80211_FCTL_RETRY)); */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008066 return 1;
8067}
8068
James Ketrenosb095c382005-08-24 22:04:42 -05008069static void ipw_handle_mgmt_packet(struct ipw_priv *priv,
8070 struct ipw_rx_mem_buffer *rxb,
8071 struct ieee80211_rx_stats *stats)
8072{
8073 struct sk_buff *skb = rxb->skb;
8074 struct ipw_rx_packet *pkt = (struct ipw_rx_packet *)skb->data;
8075 struct ieee80211_hdr_4addr *header = (struct ieee80211_hdr_4addr *)
8076 (skb->data + IPW_RX_FRAME_SIZE);
8077
8078 ieee80211_rx_mgt(priv->ieee, header, stats);
8079
8080 if (priv->ieee->iw_mode == IW_MODE_ADHOC &&
8081 ((WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8082 IEEE80211_STYPE_PROBE_RESP) ||
8083 (WLAN_FC_GET_STYPE(le16_to_cpu(header->frame_ctl)) ==
8084 IEEE80211_STYPE_BEACON))) {
8085 if (!memcmp(header->addr3, priv->bssid, ETH_ALEN))
8086 ipw_add_station(priv, header->addr2);
8087 }
8088
8089 if (priv->config & CFG_NET_STATS) {
8090 IPW_DEBUG_HC("sending stat packet\n");
8091
8092 /* Set the size of the skb to the size of the full
8093 * ipw header and 802.11 frame */
8094 skb_put(skb, le16_to_cpu(pkt->u.frame.length) +
8095 IPW_RX_FRAME_SIZE);
8096
8097 /* Advance past the ipw packet header to the 802.11 frame */
8098 skb_pull(skb, IPW_RX_FRAME_SIZE);
8099
8100 /* Push the ieee80211_rx_stats before the 802.11 frame */
8101 memcpy(skb_push(skb, sizeof(*stats)), stats, sizeof(*stats));
8102
8103 skb->dev = priv->ieee->dev;
8104
8105 /* Point raw at the ieee80211_stats */
8106 skb->mac.raw = skb->data;
8107
8108 skb->pkt_type = PACKET_OTHERHOST;
8109 skb->protocol = __constant_htons(ETH_P_80211_STATS);
8110 memset(skb->cb, 0, sizeof(rxb->skb->cb));
8111 netif_rx(skb);
8112 rxb->skb = NULL;
8113 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008114}
8115
James Ketrenos43f66a62005-03-25 12:31:53 -06008116/*
8117 * Main entry function for recieving a packet with 80211 headers. This
8118 * should be called when ever the FW has notified us that there is a new
8119 * skb in the recieve queue.
8120 */
8121static void ipw_rx(struct ipw_priv *priv)
8122{
8123 struct ipw_rx_mem_buffer *rxb;
8124 struct ipw_rx_packet *pkt;
James Ketrenos0dacca12005-09-21 12:23:41 -05008125 struct ieee80211_hdr_4addr *header;
James Ketrenos43f66a62005-03-25 12:31:53 -06008126 u32 r, w, i;
8127 u8 network_packet;
8128
James Ketrenosb095c382005-08-24 22:04:42 -05008129 r = ipw_read32(priv, IPW_RX_READ_INDEX);
8130 w = ipw_read32(priv, IPW_RX_WRITE_INDEX);
James Ketrenos43f66a62005-03-25 12:31:53 -06008131 i = (priv->rxq->processed + 1) % RX_QUEUE_SIZE;
8132
8133 while (i != r) {
8134 rxb = priv->rxq->queue[i];
James Ketrenos43f66a62005-03-25 12:31:53 -06008135 if (unlikely(rxb == NULL)) {
8136 printk(KERN_CRIT "Queue not allocated!\n");
8137 break;
8138 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008139 priv->rxq->queue[i] = NULL;
8140
8141 pci_dma_sync_single_for_cpu(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008142 IPW_RX_BUF_SIZE,
James Ketrenos43f66a62005-03-25 12:31:53 -06008143 PCI_DMA_FROMDEVICE);
8144
8145 pkt = (struct ipw_rx_packet *)rxb->skb->data;
8146 IPW_DEBUG_RX("Packet: type=%02X seq=%02X bits=%02X\n",
8147 pkt->header.message_type,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008148 pkt->header.rx_seq_num, pkt->header.control_bits);
James Ketrenos43f66a62005-03-25 12:31:53 -06008149
8150 switch (pkt->header.message_type) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008151 case RX_FRAME_TYPE: /* 802.11 frame */ {
8152 struct ieee80211_rx_stats stats = {
Zhu Yi851ca262006-08-21 11:37:58 +08008153 .rssi = pkt->u.frame.rssi_dbm -
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008154 IPW_RSSI_TO_DBM,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008155 .signal =
Bill Mossb1916082006-02-15 08:50:18 +08008156 le16_to_cpu(pkt->u.frame.rssi_dbm) -
8157 IPW_RSSI_TO_DBM + 0x100,
James Ketrenosc848d0a2005-08-24 21:56:24 -05008158 .noise =
8159 le16_to_cpu(pkt->u.frame.noise),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008160 .rate = pkt->u.frame.rate,
8161 .mac_time = jiffies,
8162 .received_channel =
8163 pkt->u.frame.received_channel,
8164 .freq =
8165 (pkt->u.frame.
8166 control & (1 << 0)) ?
8167 IEEE80211_24GHZ_BAND :
8168 IEEE80211_52GHZ_BAND,
James Ketrenosa613bff2005-08-24 21:43:11 -05008169 .len = le16_to_cpu(pkt->u.frame.length),
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008170 };
James Ketrenos43f66a62005-03-25 12:31:53 -06008171
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008172 if (stats.rssi != 0)
8173 stats.mask |= IEEE80211_STATMASK_RSSI;
8174 if (stats.signal != 0)
8175 stats.mask |= IEEE80211_STATMASK_SIGNAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008176 if (stats.noise != 0)
8177 stats.mask |= IEEE80211_STATMASK_NOISE;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008178 if (stats.rate != 0)
8179 stats.mask |= IEEE80211_STATMASK_RATE;
James Ketrenos43f66a62005-03-25 12:31:53 -06008180
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008181 priv->rx_packets++;
James Ketrenos43f66a62005-03-25 12:31:53 -06008182
Zhu Yid685b8c2006-04-13 17:20:27 +08008183#ifdef CONFIG_IPW2200_PROMISCUOUS
8184 if (priv->prom_net_dev && netif_running(priv->prom_net_dev))
8185 ipw_handle_promiscuous_rx(priv, rxb, &stats);
8186#endif
8187
James Ketrenosb095c382005-08-24 22:04:42 -05008188#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008189 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08008190#ifdef CONFIG_IPW2200_RADIOTAP
Zhu Yid685b8c2006-04-13 17:20:27 +08008191
8192 ipw_handle_data_packet_monitor(priv,
8193 rxb,
8194 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008195#else
Zhu Yid685b8c2006-04-13 17:20:27 +08008196 ipw_handle_data_packet(priv, rxb,
8197 &stats);
Mike Kershaw24a47db2005-08-26 00:41:54 -05008198#endif
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008199 break;
8200 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008201#endif
Jeff Garzikbf794512005-07-31 13:07:26 -04008202
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008203 header =
James Ketrenos0dacca12005-09-21 12:23:41 -05008204 (struct ieee80211_hdr_4addr *)(rxb->skb->
8205 data +
8206 IPW_RX_FRAME_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008207 /* TODO: Check Ad-Hoc dest/source and make sure
8208 * that we are actually parsing these packets
Jeff Garzikbf794512005-07-31 13:07:26 -04008209 * correctly -- we should probably use the
James Ketrenos43f66a62005-03-25 12:31:53 -06008210 * frame control of the packet and disregard
8211 * the current iw_mode */
James Ketrenos43f66a62005-03-25 12:31:53 -06008212
James Ketrenosea2b26e2005-08-24 21:25:16 -05008213 network_packet =
8214 is_network_packet(priv, header);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008215 if (network_packet && priv->assoc_network) {
8216 priv->assoc_network->stats.rssi =
8217 stats.rssi;
Zhu Yi00d21de2006-04-13 17:19:02 +08008218 priv->exp_avg_rssi =
8219 exponential_average(priv->exp_avg_rssi,
8220 stats.rssi, DEPTH_RSSI);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008221 }
8222
8223 IPW_DEBUG_RX("Frame: len=%u\n",
James Ketrenosa613bff2005-08-24 21:43:11 -05008224 le16_to_cpu(pkt->u.frame.length));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008225
James Ketrenosa613bff2005-08-24 21:43:11 -05008226 if (le16_to_cpu(pkt->u.frame.length) <
Zhu Yi9d0be032006-02-15 06:18:19 +08008227 ieee80211_get_hdrlen(le16_to_cpu(
8228 header->frame_ctl))) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008229 IPW_DEBUG_DROP
8230 ("Received packet is too small. "
8231 "Dropping.\n");
8232 priv->ieee->stats.rx_errors++;
8233 priv->wstats.discard.misc++;
8234 break;
8235 }
8236
James Ketrenosa613bff2005-08-24 21:43:11 -05008237 switch (WLAN_FC_GET_TYPE
8238 (le16_to_cpu(header->frame_ctl))) {
James Ketrenosb095c382005-08-24 22:04:42 -05008239
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008240 case IEEE80211_FTYPE_MGMT:
James Ketrenosb095c382005-08-24 22:04:42 -05008241 ipw_handle_mgmt_packet(priv, rxb,
8242 &stats);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008243 break;
8244
8245 case IEEE80211_FTYPE_CTL:
8246 break;
8247
8248 case IEEE80211_FTYPE_DATA:
James Ketrenosafbf30a2005-08-25 00:05:33 -05008249 if (unlikely(!network_packet ||
8250 is_duplicate_packet(priv,
8251 header)))
8252 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008253 IPW_DEBUG_DROP("Dropping: "
8254 MAC_FMT ", "
8255 MAC_FMT ", "
8256 MAC_FMT "\n",
8257 MAC_ARG(header->
8258 addr1),
8259 MAC_ARG(header->
8260 addr2),
8261 MAC_ARG(header->
8262 addr3));
James Ketrenosb095c382005-08-24 22:04:42 -05008263 break;
8264 }
8265
8266 ipw_handle_data_packet(priv, rxb,
8267 &stats);
8268
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008269 break;
8270 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008271 break;
8272 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008273
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008274 case RX_HOST_NOTIFICATION_TYPE:{
8275 IPW_DEBUG_RX
8276 ("Notification: subtype=%02X flags=%02X size=%d\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008277 pkt->u.notification.subtype,
8278 pkt->u.notification.flags,
8279 pkt->u.notification.size);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008280 ipw_rx_notification(priv, &pkt->u.notification);
8281 break;
8282 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008283
8284 default:
8285 IPW_DEBUG_RX("Bad Rx packet of type %d\n",
8286 pkt->header.message_type);
8287 break;
8288 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008289
8290 /* For now we just don't re-use anything. We can tweak this
8291 * later to try and re-use notification packets and SKBs that
James Ketrenos43f66a62005-03-25 12:31:53 -06008292 * fail to Rx correctly */
8293 if (rxb->skb != NULL) {
8294 dev_kfree_skb_any(rxb->skb);
8295 rxb->skb = NULL;
8296 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008297
James Ketrenos43f66a62005-03-25 12:31:53 -06008298 pci_unmap_single(priv->pci_dev, rxb->dma_addr,
James Ketrenosb095c382005-08-24 22:04:42 -05008299 IPW_RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008300 list_add_tail(&rxb->list, &priv->rxq->rx_used);
Jeff Garzikbf794512005-07-31 13:07:26 -04008301
James Ketrenos43f66a62005-03-25 12:31:53 -06008302 i = (i + 1) % RX_QUEUE_SIZE;
8303 }
8304
8305 /* Backtrack one entry */
8306 priv->rxq->processed = (i ? i : RX_QUEUE_SIZE) - 1;
8307
8308 ipw_rx_queue_restock(priv);
8309}
8310
James Ketrenosafbf30a2005-08-25 00:05:33 -05008311#define DEFAULT_RTS_THRESHOLD 2304U
8312#define MIN_RTS_THRESHOLD 1U
8313#define MAX_RTS_THRESHOLD 2304U
8314#define DEFAULT_BEACON_INTERVAL 100U
8315#define DEFAULT_SHORT_RETRY_LIMIT 7U
8316#define DEFAULT_LONG_RETRY_LIMIT 4U
8317
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008318/**
8319 * ipw_sw_reset
8320 * @option: options to control different reset behaviour
8321 * 0 = reset everything except the 'disable' module_param
8322 * 1 = reset everything and print out driver info (for probe only)
8323 * 2 = reset everything
8324 */
8325static int ipw_sw_reset(struct ipw_priv *priv, int option)
James Ketrenos43f66a62005-03-25 12:31:53 -06008326{
James Ketrenosafbf30a2005-08-25 00:05:33 -05008327 int band, modulation;
8328 int old_mode = priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008329
James Ketrenosafbf30a2005-08-25 00:05:33 -05008330 /* Initialize module parameter values here */
8331 priv->config = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008332
James Ketrenosafbf30a2005-08-25 00:05:33 -05008333 /* We default to disabling the LED code as right now it causes
8334 * too many systems to lock up... */
8335 if (!led)
8336 priv->config |= CFG_NO_LED;
James Ketrenos43f66a62005-03-25 12:31:53 -06008337
James Ketrenosafbf30a2005-08-25 00:05:33 -05008338 if (associate)
8339 priv->config |= CFG_ASSOCIATE;
8340 else
8341 IPW_DEBUG_INFO("Auto associate disabled.\n");
Jeff Garzikbf794512005-07-31 13:07:26 -04008342
James Ketrenosafbf30a2005-08-25 00:05:33 -05008343 if (auto_create)
8344 priv->config |= CFG_ADHOC_CREATE;
8345 else
8346 IPW_DEBUG_INFO("Auto adhoc creation disabled.\n");
8347
Zhu Yi17ed0812006-01-24 16:36:31 +08008348 priv->config &= ~CFG_STATIC_ESSID;
8349 priv->essid_len = 0;
8350 memset(priv->essid, 0, IW_ESSID_MAX_SIZE);
8351
Zhu Yid6d5b5c2006-02-16 16:21:09 +08008352 if (disable && option) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008353 priv->status |= STATUS_RF_KILL_SW;
8354 IPW_DEBUG_INFO("Radio disabled.\n");
James Ketrenos43f66a62005-03-25 12:31:53 -06008355 }
8356
James Ketrenosafbf30a2005-08-25 00:05:33 -05008357 if (channel != 0) {
8358 priv->config |= CFG_STATIC_CHANNEL;
8359 priv->channel = channel;
8360 IPW_DEBUG_INFO("Bind to static channel %d\n", channel);
8361 /* TODO: Validate that provided channel is in range */
8362 }
Zhu Yie43e3c12006-04-13 17:20:45 +08008363#ifdef CONFIG_IPW2200_QOS
James Ketrenosafbf30a2005-08-25 00:05:33 -05008364 ipw_qos_init(priv, qos_enable, qos_burst_enable,
8365 burst_duration_CCK, burst_duration_OFDM);
Zhu Yie43e3c12006-04-13 17:20:45 +08008366#endif /* CONFIG_IPW2200_QOS */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008367
8368 switch (mode) {
8369 case 1:
8370 priv->ieee->iw_mode = IW_MODE_ADHOC;
8371 priv->net_dev->type = ARPHRD_ETHER;
8372
8373 break;
8374#ifdef CONFIG_IPW2200_MONITOR
8375 case 2:
8376 priv->ieee->iw_mode = IW_MODE_MONITOR;
Zhu Yi459d4082006-04-13 17:21:00 +08008377#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008378 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8379#else
James Ketrenosafbf30a2005-08-25 00:05:33 -05008380 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008381#endif
James Ketrenosafbf30a2005-08-25 00:05:33 -05008382 break;
8383#endif
8384 default:
8385 case 0:
8386 priv->net_dev->type = ARPHRD_ETHER;
8387 priv->ieee->iw_mode = IW_MODE_INFRA;
8388 break;
James Ketrenos43f66a62005-03-25 12:31:53 -06008389 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008390
James Ketrenosafbf30a2005-08-25 00:05:33 -05008391 if (hwcrypto) {
8392 priv->ieee->host_encrypt = 0;
8393 priv->ieee->host_encrypt_msdu = 0;
8394 priv->ieee->host_decrypt = 0;
Hong Liu567deaf2005-08-31 18:07:22 +08008395 priv->ieee->host_mc_decrypt = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008396 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05008397 IPW_DEBUG_INFO("Hardware crypto [%s]\n", hwcrypto ? "on" : "off");
James Ketrenos43f66a62005-03-25 12:31:53 -06008398
Zhu Yie402c932005-08-05 17:20:40 +08008399 /* IPW2200/2915 is abled to do hardware fragmentation. */
8400 priv->ieee->host_open_frag = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008401
James Ketrenosafbf30a2005-08-25 00:05:33 -05008402 if ((priv->pci_dev->device == 0x4223) ||
8403 (priv->pci_dev->device == 0x4224)) {
Zhu Yie8c69e22006-02-17 08:25:12 +08008404 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008405 printk(KERN_INFO DRV_NAME
8406 ": Detected Intel PRO/Wireless 2915ABG Network "
8407 "Connection\n");
8408 priv->ieee->abg_true = 1;
8409 band = IEEE80211_52GHZ_BAND | IEEE80211_24GHZ_BAND;
8410 modulation = IEEE80211_OFDM_MODULATION |
8411 IEEE80211_CCK_MODULATION;
8412 priv->adapter = IPW_2915ABG;
8413 priv->ieee->mode = IEEE_A | IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008414 } else {
Zhu Yie8c69e22006-02-17 08:25:12 +08008415 if (option == 1)
James Ketrenosafbf30a2005-08-25 00:05:33 -05008416 printk(KERN_INFO DRV_NAME
8417 ": Detected Intel PRO/Wireless 2200BG Network "
8418 "Connection\n");
8419
8420 priv->ieee->abg_true = 0;
8421 band = IEEE80211_24GHZ_BAND;
8422 modulation = IEEE80211_OFDM_MODULATION |
8423 IEEE80211_CCK_MODULATION;
8424 priv->adapter = IPW_2200BG;
8425 priv->ieee->mode = IEEE_G | IEEE_B;
James Ketrenos43f66a62005-03-25 12:31:53 -06008426 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008427
James Ketrenosafbf30a2005-08-25 00:05:33 -05008428 priv->ieee->freq_band = band;
8429 priv->ieee->modulation = modulation;
Jeff Garzikbf794512005-07-31 13:07:26 -04008430
James Ketrenosafbf30a2005-08-25 00:05:33 -05008431 priv->rates_mask = IEEE80211_DEFAULT_RATES_MASK;
James Ketrenos43f66a62005-03-25 12:31:53 -06008432
James Ketrenosafbf30a2005-08-25 00:05:33 -05008433 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8434 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008435
James Ketrenosafbf30a2005-08-25 00:05:33 -05008436 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
8437 priv->short_retry_limit = DEFAULT_SHORT_RETRY_LIMIT;
8438 priv->long_retry_limit = DEFAULT_LONG_RETRY_LIMIT;
Jeff Garzikbf794512005-07-31 13:07:26 -04008439
James Ketrenosafbf30a2005-08-25 00:05:33 -05008440 /* If power management is turned on, default to AC mode */
8441 priv->power_mode = IPW_POWER_AC;
8442 priv->tx_power = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06008443
Zhu Yi0ece35b2005-08-05 17:26:51 +08008444 return old_mode == priv->ieee->iw_mode;
James Ketrenos43f66a62005-03-25 12:31:53 -06008445}
8446
8447/*
8448 * This file defines the Wireless Extension handlers. It does not
8449 * define any methods of hardware manipulation and relies on the
8450 * functions defined in ipw_main to provide the HW interaction.
Jeff Garzikbf794512005-07-31 13:07:26 -04008451 *
8452 * The exception to this is the use of the ipw_get_ordinal()
James Ketrenos43f66a62005-03-25 12:31:53 -06008453 * function used to poll the hardware vs. making unecessary calls.
8454 *
8455 */
8456
Jeff Garzikbf794512005-07-31 13:07:26 -04008457static int ipw_wx_get_name(struct net_device *dev,
8458 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008459 union iwreq_data *wrqu, char *extra)
8460{
8461 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008462 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008463 if (priv->status & STATUS_RF_KILL_MASK)
James Ketrenosa613bff2005-08-24 21:43:11 -05008464 strcpy(wrqu->name, "radio off");
James Ketrenosc848d0a2005-08-24 21:56:24 -05008465 else if (!(priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -06008466 strcpy(wrqu->name, "unassociated");
Jeff Garzikbf794512005-07-31 13:07:26 -04008467 else
James Ketrenos43f66a62005-03-25 12:31:53 -06008468 snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11%c",
8469 ipw_modes[priv->assoc_request.ieee_mode]);
8470 IPW_DEBUG_WX("Name: %s\n", wrqu->name);
Zhu Yi46441512006-01-24 16:37:59 +08008471 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008472 return 0;
8473}
8474
8475static int ipw_set_channel(struct ipw_priv *priv, u8 channel)
8476{
8477 if (channel == 0) {
8478 IPW_DEBUG_INFO("Setting channel to ANY (0)\n");
8479 priv->config &= ~CFG_STATIC_CHANNEL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008480 IPW_DEBUG_ASSOC("Attempting to associate with new "
8481 "parameters.\n");
8482 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008483 return 0;
8484 }
8485
8486 priv->config |= CFG_STATIC_CHANNEL;
8487
8488 if (priv->channel == channel) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008489 IPW_DEBUG_INFO("Request to set channel to current value (%d)\n",
8490 channel);
James Ketrenos43f66a62005-03-25 12:31:53 -06008491 return 0;
8492 }
8493
8494 IPW_DEBUG_INFO("Setting channel to %i\n", (int)channel);
8495 priv->channel = channel;
8496
James Ketrenosb095c382005-08-24 22:04:42 -05008497#ifdef CONFIG_IPW2200_MONITOR
8498 if (priv->ieee->iw_mode == IW_MODE_MONITOR) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008499 int i;
James Ketrenosb095c382005-08-24 22:04:42 -05008500 if (priv->status & STATUS_SCANNING) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008501 IPW_DEBUG_SCAN("Scan abort triggered due to "
James Ketrenosb095c382005-08-24 22:04:42 -05008502 "channel change.\n");
James Ketrenosafbf30a2005-08-25 00:05:33 -05008503 ipw_abort_scan(priv);
James Ketrenosb095c382005-08-24 22:04:42 -05008504 }
8505
8506 for (i = 1000; i && (priv->status & STATUS_SCANNING); i--)
8507 udelay(10);
8508
8509 if (priv->status & STATUS_SCANNING)
8510 IPW_DEBUG_SCAN("Still scanning...\n");
8511 else
8512 IPW_DEBUG_SCAN("Took %dms to abort current scan\n",
8513 1000 - i);
8514
8515 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008516 }
James Ketrenosb095c382005-08-24 22:04:42 -05008517#endif /* CONFIG_IPW2200_MONITOR */
8518
James Ketrenosc848d0a2005-08-24 21:56:24 -05008519 /* Network configuration changed -- force [re]association */
8520 IPW_DEBUG_ASSOC("[re]association triggered due to channel change.\n");
8521 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008522 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008523
8524 return 0;
8525}
8526
Jeff Garzikbf794512005-07-31 13:07:26 -04008527static int ipw_wx_set_freq(struct net_device *dev,
8528 struct iw_request_info *info,
8529 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008530{
8531 struct ipw_priv *priv = ieee80211_priv(dev);
Larry Finger1867b112006-02-28 09:48:28 -06008532 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenos43f66a62005-03-25 12:31:53 -06008533 struct iw_freq *fwrq = &wrqu->freq;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008534 int ret = 0, i;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008535 u8 channel, flags;
8536 int band;
Jeff Garzikbf794512005-07-31 13:07:26 -04008537
James Ketrenosb095c382005-08-24 22:04:42 -05008538 if (fwrq->m == 0) {
8539 IPW_DEBUG_WX("SET Freq/Channel -> any\n");
Zhu Yi46441512006-01-24 16:37:59 +08008540 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008541 ret = ipw_set_channel(priv, 0);
Zhu Yi46441512006-01-24 16:37:59 +08008542 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008543 return ret;
8544 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008545 /* if setting by freq convert to channel */
8546 if (fwrq->e == 1) {
Larry Finger1867b112006-02-28 09:48:28 -06008547 channel = ieee80211_freq_to_channel(priv->ieee, fwrq->m);
James Ketrenosb095c382005-08-24 22:04:42 -05008548 if (channel == 0)
8549 return -EINVAL;
8550 } else
8551 channel = fwrq->m;
Jeff Garzikbf794512005-07-31 13:07:26 -04008552
Larry Finger1867b112006-02-28 09:48:28 -06008553 if (!(band = ieee80211_is_valid_channel(priv->ieee, channel)))
James Ketrenosb095c382005-08-24 22:04:42 -05008554 return -EINVAL;
Jeff Garzikbf794512005-07-31 13:07:26 -04008555
Liu Hong1fe0adb2005-08-19 09:33:10 -05008556 if (priv->ieee->iw_mode == IW_MODE_ADHOC) {
Larry Finger1867b112006-02-28 09:48:28 -06008557 i = ieee80211_channel_to_index(priv->ieee, channel);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008558 if (i == -1)
8559 return -EINVAL;
Liu Hong1fe0adb2005-08-19 09:33:10 -05008560
8561 flags = (band == IEEE80211_24GHZ_BAND) ?
8562 geo->bg[i].flags : geo->a[i].flags;
8563 if (flags & IEEE80211_CH_PASSIVE_ONLY) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05008564 IPW_DEBUG_WX("Invalid Ad-Hoc channel for 802.11a\n");
8565 return -EINVAL;
James Ketrenos43f66a62005-03-25 12:31:53 -06008566 }
8567 }
Jeff Garzikbf794512005-07-31 13:07:26 -04008568
James Ketrenos43f66a62005-03-25 12:31:53 -06008569 IPW_DEBUG_WX("SET Freq/Channel -> %d \n", fwrq->m);
Zhu Yi46441512006-01-24 16:37:59 +08008570 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05008571 ret = ipw_set_channel(priv, channel);
Zhu Yi46441512006-01-24 16:37:59 +08008572 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05008573 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06008574}
8575
Jeff Garzikbf794512005-07-31 13:07:26 -04008576static int ipw_wx_get_freq(struct net_device *dev,
8577 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008578 union iwreq_data *wrqu, char *extra)
8579{
8580 struct ipw_priv *priv = ieee80211_priv(dev);
8581
8582 wrqu->freq.e = 0;
8583
8584 /* If we are associated, trying to associate, or have a statically
8585 * configured CHANNEL then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008586 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008587 if (priv->config & CFG_STATIC_CHANNEL ||
Zhu Yic580f672006-08-21 11:37:01 +08008588 priv->status & (STATUS_ASSOCIATING | STATUS_ASSOCIATED)) {
8589 int i;
8590
8591 i = ieee80211_channel_to_index(priv->ieee, priv->channel);
8592 BUG_ON(i == -1);
8593 wrqu->freq.e = 1;
8594
8595 switch (ieee80211_is_valid_channel(priv->ieee, priv->channel)) {
8596 case IEEE80211_52GHZ_BAND:
8597 wrqu->freq.m = priv->ieee->geo.a[i].freq * 100000;
8598 break;
8599
8600 case IEEE80211_24GHZ_BAND:
8601 wrqu->freq.m = priv->ieee->geo.bg[i].freq * 100000;
8602 break;
8603
8604 default:
8605 BUG();
8606 }
8607 } else
James Ketrenos43f66a62005-03-25 12:31:53 -06008608 wrqu->freq.m = 0;
8609
Zhu Yi46441512006-01-24 16:37:59 +08008610 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008611 IPW_DEBUG_WX("GET Freq/Channel -> %d \n", priv->channel);
8612 return 0;
8613}
8614
Jeff Garzikbf794512005-07-31 13:07:26 -04008615static int ipw_wx_set_mode(struct net_device *dev,
8616 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008617 union iwreq_data *wrqu, char *extra)
8618{
8619 struct ipw_priv *priv = ieee80211_priv(dev);
8620 int err = 0;
8621
8622 IPW_DEBUG_WX("Set MODE: %d\n", wrqu->mode);
8623
James Ketrenos43f66a62005-03-25 12:31:53 -06008624 switch (wrqu->mode) {
James Ketrenosb095c382005-08-24 22:04:42 -05008625#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -06008626 case IW_MODE_MONITOR:
8627#endif
8628 case IW_MODE_ADHOC:
8629 case IW_MODE_INFRA:
8630 break;
8631 case IW_MODE_AUTO:
8632 wrqu->mode = IW_MODE_INFRA;
8633 break;
8634 default:
8635 return -EINVAL;
8636 }
James Ketrenosb095c382005-08-24 22:04:42 -05008637 if (wrqu->mode == priv->ieee->iw_mode)
8638 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06008639
Zhu Yi46441512006-01-24 16:37:59 +08008640 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05008641
8642 ipw_sw_reset(priv, 0);
8643
James Ketrenosb095c382005-08-24 22:04:42 -05008644#ifdef CONFIG_IPW2200_MONITOR
Jeff Garzikbf794512005-07-31 13:07:26 -04008645 if (priv->ieee->iw_mode == IW_MODE_MONITOR)
James Ketrenos43f66a62005-03-25 12:31:53 -06008646 priv->net_dev->type = ARPHRD_ETHER;
Jeff Garzikbf794512005-07-31 13:07:26 -04008647
8648 if (wrqu->mode == IW_MODE_MONITOR)
Zhu Yi459d4082006-04-13 17:21:00 +08008649#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05008650 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
8651#else
James Ketrenos43f66a62005-03-25 12:31:53 -06008652 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05008653#endif
James Ketrenosb095c382005-08-24 22:04:42 -05008654#endif /* CONFIG_IPW2200_MONITOR */
Jeff Garzikbf794512005-07-31 13:07:26 -04008655
Jeff Garzikbf794512005-07-31 13:07:26 -04008656 /* Free the existing firmware and reset the fw_loaded
James Ketrenos43f66a62005-03-25 12:31:53 -06008657 * flag so ipw_load() will bring in the new firmawre */
James Ketrenosafbf30a2005-08-25 00:05:33 -05008658 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -06008659
8660 priv->ieee->iw_mode = wrqu->mode;
Jeff Garzikbf794512005-07-31 13:07:26 -04008661
James Ketrenosc848d0a2005-08-24 21:56:24 -05008662 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +08008663 mutex_unlock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008664 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06008665}
8666
Jeff Garzikbf794512005-07-31 13:07:26 -04008667static int ipw_wx_get_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008668 struct iw_request_info *info,
8669 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06008670{
8671 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08008672 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008673 wrqu->mode = priv->ieee->iw_mode;
8674 IPW_DEBUG_WX("Get MODE -> %d\n", wrqu->mode);
Zhu Yi46441512006-01-24 16:37:59 +08008675 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008676 return 0;
8677}
8678
James Ketrenos43f66a62005-03-25 12:31:53 -06008679/* Values are in microsecond */
8680static const s32 timeout_duration[] = {
8681 350000,
8682 250000,
8683 75000,
8684 37000,
8685 25000,
8686};
8687
8688static const s32 period_duration[] = {
8689 400000,
8690 700000,
8691 1000000,
8692 1000000,
8693 1000000
8694};
8695
Jeff Garzikbf794512005-07-31 13:07:26 -04008696static int ipw_wx_get_range(struct net_device *dev,
8697 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008698 union iwreq_data *wrqu, char *extra)
8699{
8700 struct ipw_priv *priv = ieee80211_priv(dev);
8701 struct iw_range *range = (struct iw_range *)extra;
Larry Finger1867b112006-02-28 09:48:28 -06008702 const struct ieee80211_geo *geo = ieee80211_get_geo(priv->ieee);
James Ketrenosb095c382005-08-24 22:04:42 -05008703 int i = 0, j;
James Ketrenos43f66a62005-03-25 12:31:53 -06008704
8705 wrqu->data.length = sizeof(*range);
8706 memset(range, 0, sizeof(*range));
8707
8708 /* 54Mbs == ~27 Mb/s real (802.11g) */
Jeff Garzikbf794512005-07-31 13:07:26 -04008709 range->throughput = 27 * 1000 * 1000;
James Ketrenos43f66a62005-03-25 12:31:53 -06008710
8711 range->max_qual.qual = 100;
8712 /* TODO: Find real max RSSI and stick here */
8713 range->max_qual.level = 0;
Bill Mossb1916082006-02-15 08:50:18 +08008714 range->max_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008715 range->max_qual.updated = 7; /* Updated all three */
James Ketrenos43f66a62005-03-25 12:31:53 -06008716
8717 range->avg_qual.qual = 70;
8718 /* TODO: Find real 'good' to 'bad' threshol value for RSSI */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008719 range->avg_qual.level = 0; /* FIXME to real average level */
James Ketrenos43f66a62005-03-25 12:31:53 -06008720 range->avg_qual.noise = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008721 range->avg_qual.updated = 7; /* Updated all three */
Zhu Yi46441512006-01-24 16:37:59 +08008722 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008723 range->num_bitrates = min(priv->rates.num_rates, (u8) IW_MAX_BITRATES);
James Ketrenos43f66a62005-03-25 12:31:53 -06008724
Jeff Garzikbf794512005-07-31 13:07:26 -04008725 for (i = 0; i < range->num_bitrates; i++)
8726 range->bitrate[i] = (priv->rates.supported_rates[i] & 0x7F) *
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008727 500000;
Jeff Garzikbf794512005-07-31 13:07:26 -04008728
James Ketrenos43f66a62005-03-25 12:31:53 -06008729 range->max_rts = DEFAULT_RTS_THRESHOLD;
8730 range->min_frag = MIN_FRAG_THRESHOLD;
8731 range->max_frag = MAX_FRAG_THRESHOLD;
8732
8733 range->encoding_size[0] = 5;
Jeff Garzikbf794512005-07-31 13:07:26 -04008734 range->encoding_size[1] = 13;
James Ketrenos43f66a62005-03-25 12:31:53 -06008735 range->num_encoding_sizes = 2;
8736 range->max_encoding_tokens = WEP_KEYS;
8737
8738 /* Set the Wireless Extension versions */
8739 range->we_version_compiled = WIRELESS_EXT;
Dan Williamsf1b50862006-01-30 13:58:56 -05008740 range->we_version_source = 18;
James Ketrenos43f66a62005-03-25 12:31:53 -06008741
James Ketrenosb095c382005-08-24 22:04:42 -05008742 i = 0;
8743 if (priv->ieee->mode & (IEEE_B | IEEE_G)) {
Zhu Yie815de42006-03-02 05:55:51 +08008744 for (j = 0; j < geo->bg_channels && i < IW_MAX_FREQUENCIES; j++) {
8745 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8746 (geo->bg[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8747 continue;
8748
James Ketrenosb095c382005-08-24 22:04:42 -05008749 range->freq[i].i = geo->bg[j].channel;
8750 range->freq[i].m = geo->bg[j].freq * 100000;
8751 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008752 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008753 }
James Ketrenos43f66a62005-03-25 12:31:53 -06008754 }
James Ketrenosb095c382005-08-24 22:04:42 -05008755
8756 if (priv->ieee->mode & IEEE_A) {
Zhu Yie815de42006-03-02 05:55:51 +08008757 for (j = 0; j < geo->a_channels && i < IW_MAX_FREQUENCIES; j++) {
8758 if ((priv->ieee->iw_mode == IW_MODE_ADHOC) &&
8759 (geo->a[j].flags & IEEE80211_CH_PASSIVE_ONLY))
8760 continue;
8761
James Ketrenosb095c382005-08-24 22:04:42 -05008762 range->freq[i].i = geo->a[j].channel;
8763 range->freq[i].m = geo->a[j].freq * 100000;
8764 range->freq[i].e = 1;
Zhu Yie815de42006-03-02 05:55:51 +08008765 i++;
James Ketrenosb095c382005-08-24 22:04:42 -05008766 }
8767 }
8768
8769 range->num_channels = i;
8770 range->num_frequency = i;
8771
Zhu Yi46441512006-01-24 16:37:59 +08008772 mutex_unlock(&priv->mutex);
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008773
8774 /* Event capability (kernel + driver) */
8775 range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
8776 IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
Zhu Yi07f02e42006-04-13 17:19:25 +08008777 IW_EVENT_CAPA_MASK(SIOCGIWAP) |
8778 IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00008779 range->event_capa[1] = IW_EVENT_CAPA_K_1;
James Ketrenos43f66a62005-03-25 12:31:53 -06008780
Dan Williamsf1b50862006-01-30 13:58:56 -05008781 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
8782 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
8783
James Ketrenos43f66a62005-03-25 12:31:53 -06008784 IPW_DEBUG_WX("GET Range\n");
8785 return 0;
8786}
8787
Jeff Garzikbf794512005-07-31 13:07:26 -04008788static int ipw_wx_set_wap(struct net_device *dev,
8789 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008790 union iwreq_data *wrqu, char *extra)
8791{
8792 struct ipw_priv *priv = ieee80211_priv(dev);
8793
8794 static const unsigned char any[] = {
8795 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
8796 };
8797 static const unsigned char off[] = {
8798 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
8799 };
8800
Jeff Garzikbf794512005-07-31 13:07:26 -04008801 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
James Ketrenos43f66a62005-03-25 12:31:53 -06008802 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +08008803 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008804 if (!memcmp(any, wrqu->ap_addr.sa_data, ETH_ALEN) ||
8805 !memcmp(off, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8806 /* we disable mandatory BSSID association */
8807 IPW_DEBUG_WX("Setting AP BSSID to ANY\n");
8808 priv->config &= ~CFG_STATIC_BSSID;
James Ketrenosc848d0a2005-08-24 21:56:24 -05008809 IPW_DEBUG_ASSOC("Attempting to associate with new "
8810 "parameters.\n");
8811 ipw_associate(priv);
Zhu Yi46441512006-01-24 16:37:59 +08008812 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008813 return 0;
8814 }
8815
8816 priv->config |= CFG_STATIC_BSSID;
8817 if (!memcmp(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN)) {
8818 IPW_DEBUG_WX("BSSID set to current BSSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008819 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008820 return 0;
8821 }
8822
8823 IPW_DEBUG_WX("Setting mandatory BSSID to " MAC_FMT "\n",
8824 MAC_ARG(wrqu->ap_addr.sa_data));
8825
8826 memcpy(priv->bssid, wrqu->ap_addr.sa_data, ETH_ALEN);
8827
James Ketrenosc848d0a2005-08-24 21:56:24 -05008828 /* Network configuration changed -- force [re]association */
8829 IPW_DEBUG_ASSOC("[re]association triggered due to BSSID change.\n");
8830 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008831 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008832
Zhu Yi46441512006-01-24 16:37:59 +08008833 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008834 return 0;
8835}
8836
Jeff Garzikbf794512005-07-31 13:07:26 -04008837static int ipw_wx_get_wap(struct net_device *dev,
8838 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008839 union iwreq_data *wrqu, char *extra)
8840{
8841 struct ipw_priv *priv = ieee80211_priv(dev);
8842 /* If we are associated, trying to associate, or have a statically
8843 * configured BSSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008844 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04008845 if (priv->config & CFG_STATIC_BSSID ||
James Ketrenos43f66a62005-03-25 12:31:53 -06008846 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8847 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
James Ketrenosafbf30a2005-08-25 00:05:33 -05008848 memcpy(wrqu->ap_addr.sa_data, priv->bssid, ETH_ALEN);
James Ketrenos43f66a62005-03-25 12:31:53 -06008849 } else
8850 memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN);
8851
8852 IPW_DEBUG_WX("Getting WAP BSSID: " MAC_FMT "\n",
8853 MAC_ARG(wrqu->ap_addr.sa_data));
Zhu Yi46441512006-01-24 16:37:59 +08008854 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008855 return 0;
8856}
8857
Jeff Garzikbf794512005-07-31 13:07:26 -04008858static int ipw_wx_set_essid(struct net_device *dev,
8859 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008860 union iwreq_data *wrqu, char *extra)
8861{
8862 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yiab644b02006-08-21 11:37:13 +08008863 int length;
James Ketrenos43f66a62005-03-25 12:31:53 -06008864
Zhu Yiab644b02006-08-21 11:37:13 +08008865 mutex_lock(&priv->mutex);
8866
8867 if (!wrqu->essid.flags)
8868 {
8869 IPW_DEBUG_WX("Setting ESSID to ANY\n");
8870 ipw_disassociate(priv);
8871 priv->config &= ~CFG_STATIC_ESSID;
8872 ipw_associate(priv);
8873 mutex_unlock(&priv->mutex);
8874 return 0;
8875 }
8876
Zhu Yia9f0d422006-08-21 11:37:26 +08008877 length = min((int)wrqu->essid.length, IW_ESSID_MAX_SIZE);
James Ketrenos43f66a62005-03-25 12:31:53 -06008878
8879 priv->config |= CFG_STATIC_ESSID;
8880
Zhu Yia9f0d422006-08-21 11:37:26 +08008881 if (priv->essid_len == length && !memcmp(priv->essid, extra, length)
8882 && (priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING))) {
James Ketrenos43f66a62005-03-25 12:31:53 -06008883 IPW_DEBUG_WX("ESSID set to current ESSID.\n");
Zhu Yi46441512006-01-24 16:37:59 +08008884 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008885 return 0;
8886 }
8887
Zhu Yiab644b02006-08-21 11:37:13 +08008888 IPW_DEBUG_WX("Setting ESSID: '%s' (%d)\n", escape_essid(extra, length),
James Ketrenos43f66a62005-03-25 12:31:53 -06008889 length);
8890
8891 priv->essid_len = length;
Zhu Yia9f0d422006-08-21 11:37:26 +08008892 memcpy(priv->essid, extra, priv->essid_len);
Jeff Garzikbf794512005-07-31 13:07:26 -04008893
James Ketrenosc848d0a2005-08-24 21:56:24 -05008894 /* Network configuration changed -- force [re]association */
8895 IPW_DEBUG_ASSOC("[re]association triggered due to ESSID change.\n");
8896 if (!ipw_disassociate(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -06008897 ipw_associate(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06008898
Zhu Yi46441512006-01-24 16:37:59 +08008899 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008900 return 0;
8901}
8902
Jeff Garzikbf794512005-07-31 13:07:26 -04008903static int ipw_wx_get_essid(struct net_device *dev,
8904 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008905 union iwreq_data *wrqu, char *extra)
8906{
8907 struct ipw_priv *priv = ieee80211_priv(dev);
8908
8909 /* If we are associated, trying to associate, or have a statically
8910 * configured ESSID then return that; otherwise return ANY */
Zhu Yi46441512006-01-24 16:37:59 +08008911 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008912 if (priv->config & CFG_STATIC_ESSID ||
Jeff Garzikbf794512005-07-31 13:07:26 -04008913 priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) {
8914 IPW_DEBUG_WX("Getting essid: '%s'\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06008915 escape_essid(priv->essid, priv->essid_len));
Jeff Garzikbf794512005-07-31 13:07:26 -04008916 memcpy(extra, priv->essid, priv->essid_len);
James Ketrenos43f66a62005-03-25 12:31:53 -06008917 wrqu->essid.length = priv->essid_len;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008918 wrqu->essid.flags = 1; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06008919 } else {
8920 IPW_DEBUG_WX("Getting essid: ANY\n");
8921 wrqu->essid.length = 0;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008922 wrqu->essid.flags = 0; /* active */
James Ketrenos43f66a62005-03-25 12:31:53 -06008923 }
Zhu Yi46441512006-01-24 16:37:59 +08008924 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008925 return 0;
8926}
8927
Jeff Garzikbf794512005-07-31 13:07:26 -04008928static int ipw_wx_set_nick(struct net_device *dev,
8929 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008930 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04008931{
James Ketrenos43f66a62005-03-25 12:31:53 -06008932 struct ipw_priv *priv = ieee80211_priv(dev);
8933
8934 IPW_DEBUG_WX("Setting nick to '%s'\n", extra);
8935 if (wrqu->data.length > IW_ESSID_MAX_SIZE)
8936 return -E2BIG;
Zhu Yi46441512006-01-24 16:37:59 +08008937 mutex_lock(&priv->mutex);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008938 wrqu->data.length = min((size_t) wrqu->data.length, sizeof(priv->nick));
James Ketrenos43f66a62005-03-25 12:31:53 -06008939 memset(priv->nick, 0, sizeof(priv->nick));
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008940 memcpy(priv->nick, extra, wrqu->data.length);
James Ketrenos43f66a62005-03-25 12:31:53 -06008941 IPW_DEBUG_TRACE("<<\n");
Zhu Yi46441512006-01-24 16:37:59 +08008942 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008943 return 0;
8944
8945}
8946
Jeff Garzikbf794512005-07-31 13:07:26 -04008947static int ipw_wx_get_nick(struct net_device *dev,
8948 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06008949 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04008950{
James Ketrenos43f66a62005-03-25 12:31:53 -06008951 struct ipw_priv *priv = ieee80211_priv(dev);
8952 IPW_DEBUG_WX("Getting nick\n");
Zhu Yi46441512006-01-24 16:37:59 +08008953 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07008954 wrqu->data.length = strlen(priv->nick);
James Ketrenos43f66a62005-03-25 12:31:53 -06008955 memcpy(extra, priv->nick, wrqu->data.length);
Jeff Garzik0edd5b42005-09-07 00:48:31 -04008956 wrqu->data.flags = 1; /* active */
Zhu Yi46441512006-01-24 16:37:59 +08008957 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06008958 return 0;
8959}
8960
Olivier Hochreutiner651be262006-03-08 03:13:55 +08008961static int ipw_wx_set_sens(struct net_device *dev,
8962 struct iw_request_info *info,
8963 union iwreq_data *wrqu, char *extra)
8964{
8965 struct ipw_priv *priv = ieee80211_priv(dev);
8966 int err = 0;
8967
8968 IPW_DEBUG_WX("Setting roaming threshold to %d\n", wrqu->sens.value);
8969 IPW_DEBUG_WX("Setting disassociate threshold to %d\n", 3*wrqu->sens.value);
8970 mutex_lock(&priv->mutex);
8971
8972 if (wrqu->sens.fixed == 0)
8973 {
8974 priv->roaming_threshold = IPW_MB_ROAMING_THRESHOLD_DEFAULT;
8975 priv->disassociate_threshold = IPW_MB_DISASSOCIATE_THRESHOLD_DEFAULT;
8976 goto out;
8977 }
8978 if ((wrqu->sens.value > IPW_MB_ROAMING_THRESHOLD_MAX) ||
8979 (wrqu->sens.value < IPW_MB_ROAMING_THRESHOLD_MIN)) {
8980 err = -EINVAL;
8981 goto out;
8982 }
8983
8984 priv->roaming_threshold = wrqu->sens.value;
8985 priv->disassociate_threshold = 3*wrqu->sens.value;
8986 out:
8987 mutex_unlock(&priv->mutex);
8988 return err;
8989}
8990
8991static int ipw_wx_get_sens(struct net_device *dev,
8992 struct iw_request_info *info,
8993 union iwreq_data *wrqu, char *extra)
8994{
8995 struct ipw_priv *priv = ieee80211_priv(dev);
8996 mutex_lock(&priv->mutex);
8997 wrqu->sens.fixed = 1;
8998 wrqu->sens.value = priv->roaming_threshold;
8999 mutex_unlock(&priv->mutex);
9000
9001 IPW_DEBUG_WX("GET roaming threshold -> %s %d \n",
9002 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
9003
9004 return 0;
9005}
9006
James Ketrenos43f66a62005-03-25 12:31:53 -06009007static int ipw_wx_set_rate(struct net_device *dev,
9008 struct iw_request_info *info,
9009 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009010{
James Ketrenosea2b26e2005-08-24 21:25:16 -05009011 /* TODO: We should use semaphores or locks for access to priv */
9012 struct ipw_priv *priv = ieee80211_priv(dev);
9013 u32 target_rate = wrqu->bitrate.value;
9014 u32 fixed, mask;
9015
9016 /* value = -1, fixed = 0 means auto only, so we should use all rates offered by AP */
9017 /* value = X, fixed = 1 means only rate X */
9018 /* value = X, fixed = 0 means all rates lower equal X */
9019
9020 if (target_rate == -1) {
9021 fixed = 0;
9022 mask = IEEE80211_DEFAULT_RATES_MASK;
9023 /* Now we should reassociate */
9024 goto apply;
9025 }
9026
9027 mask = 0;
9028 fixed = wrqu->bitrate.fixed;
9029
9030 if (target_rate == 1000000 || !fixed)
9031 mask |= IEEE80211_CCK_RATE_1MB_MASK;
9032 if (target_rate == 1000000)
9033 goto apply;
9034
9035 if (target_rate == 2000000 || !fixed)
9036 mask |= IEEE80211_CCK_RATE_2MB_MASK;
9037 if (target_rate == 2000000)
9038 goto apply;
9039
9040 if (target_rate == 5500000 || !fixed)
9041 mask |= IEEE80211_CCK_RATE_5MB_MASK;
9042 if (target_rate == 5500000)
9043 goto apply;
9044
9045 if (target_rate == 6000000 || !fixed)
9046 mask |= IEEE80211_OFDM_RATE_6MB_MASK;
9047 if (target_rate == 6000000)
9048 goto apply;
9049
9050 if (target_rate == 9000000 || !fixed)
9051 mask |= IEEE80211_OFDM_RATE_9MB_MASK;
9052 if (target_rate == 9000000)
9053 goto apply;
9054
9055 if (target_rate == 11000000 || !fixed)
9056 mask |= IEEE80211_CCK_RATE_11MB_MASK;
9057 if (target_rate == 11000000)
9058 goto apply;
9059
9060 if (target_rate == 12000000 || !fixed)
9061 mask |= IEEE80211_OFDM_RATE_12MB_MASK;
9062 if (target_rate == 12000000)
9063 goto apply;
9064
9065 if (target_rate == 18000000 || !fixed)
9066 mask |= IEEE80211_OFDM_RATE_18MB_MASK;
9067 if (target_rate == 18000000)
9068 goto apply;
9069
9070 if (target_rate == 24000000 || !fixed)
9071 mask |= IEEE80211_OFDM_RATE_24MB_MASK;
9072 if (target_rate == 24000000)
9073 goto apply;
9074
9075 if (target_rate == 36000000 || !fixed)
9076 mask |= IEEE80211_OFDM_RATE_36MB_MASK;
9077 if (target_rate == 36000000)
9078 goto apply;
9079
9080 if (target_rate == 48000000 || !fixed)
9081 mask |= IEEE80211_OFDM_RATE_48MB_MASK;
9082 if (target_rate == 48000000)
9083 goto apply;
9084
9085 if (target_rate == 54000000 || !fixed)
9086 mask |= IEEE80211_OFDM_RATE_54MB_MASK;
9087 if (target_rate == 54000000)
9088 goto apply;
9089
9090 IPW_DEBUG_WX("invalid rate specified, returning error\n");
9091 return -EINVAL;
9092
9093 apply:
9094 IPW_DEBUG_WX("Setting rate mask to 0x%08X [%s]\n",
9095 mask, fixed ? "fixed" : "sub-rates");
Zhu Yi46441512006-01-24 16:37:59 +08009096 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009097 if (mask == IEEE80211_DEFAULT_RATES_MASK) {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009098 priv->config &= ~CFG_FIXED_RATE;
James Ketrenosb095c382005-08-24 22:04:42 -05009099 ipw_set_fixed_rate(priv, priv->ieee->mode);
9100 } else
James Ketrenosea2b26e2005-08-24 21:25:16 -05009101 priv->config |= CFG_FIXED_RATE;
9102
James Ketrenosc848d0a2005-08-24 21:56:24 -05009103 if (priv->rates_mask == mask) {
9104 IPW_DEBUG_WX("Mask set to current mask.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009105 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009106 return 0;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009107 }
9108
James Ketrenosc848d0a2005-08-24 21:56:24 -05009109 priv->rates_mask = mask;
9110
9111 /* Network configuration changed -- force [re]association */
9112 IPW_DEBUG_ASSOC("[re]association triggered due to rates change.\n");
9113 if (!ipw_disassociate(priv))
9114 ipw_associate(priv);
9115
Zhu Yi46441512006-01-24 16:37:59 +08009116 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009117 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009118}
9119
Jeff Garzikbf794512005-07-31 13:07:26 -04009120static int ipw_wx_get_rate(struct net_device *dev,
9121 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009122 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009123{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009124 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009125 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009126 wrqu->bitrate.value = priv->last_rate;
Zhu Yi455936c2006-04-13 17:20:05 +08009127 wrqu->bitrate.fixed = (priv->config & CFG_FIXED_RATE) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009128 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009129 IPW_DEBUG_WX("GET Rate -> %d \n", wrqu->bitrate.value);
9130 return 0;
9131}
9132
Jeff Garzikbf794512005-07-31 13:07:26 -04009133static int ipw_wx_set_rts(struct net_device *dev,
9134 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009135 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009136{
James Ketrenos43f66a62005-03-25 12:31:53 -06009137 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009138 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009139 if (wrqu->rts.disabled)
9140 priv->rts_threshold = DEFAULT_RTS_THRESHOLD;
9141 else {
9142 if (wrqu->rts.value < MIN_RTS_THRESHOLD ||
James Ketrenosc848d0a2005-08-24 21:56:24 -05009143 wrqu->rts.value > MAX_RTS_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009144 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009145 return -EINVAL;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009146 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009147 priv->rts_threshold = wrqu->rts.value;
9148 }
9149
9150 ipw_send_rts_threshold(priv, priv->rts_threshold);
Zhu Yi46441512006-01-24 16:37:59 +08009151 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009152 IPW_DEBUG_WX("SET RTS Threshold -> %d \n", priv->rts_threshold);
9153 return 0;
9154}
9155
Jeff Garzikbf794512005-07-31 13:07:26 -04009156static int ipw_wx_get_rts(struct net_device *dev,
9157 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009158 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009159{
James Ketrenos43f66a62005-03-25 12:31:53 -06009160 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009161 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009162 wrqu->rts.value = priv->rts_threshold;
9163 wrqu->rts.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009164 wrqu->rts.disabled = (wrqu->rts.value == DEFAULT_RTS_THRESHOLD);
Zhu Yi46441512006-01-24 16:37:59 +08009165 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009166 IPW_DEBUG_WX("GET RTS Threshold -> %d \n", wrqu->rts.value);
9167 return 0;
9168}
9169
Jeff Garzikbf794512005-07-31 13:07:26 -04009170static int ipw_wx_set_txpow(struct net_device *dev,
9171 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009172 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009173{
James Ketrenos43f66a62005-03-25 12:31:53 -06009174 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009175 int err = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009176
Zhu Yi46441512006-01-24 16:37:59 +08009177 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009178 if (ipw_radio_kill_sw(priv, wrqu->power.disabled)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009179 err = -EINPROGRESS;
9180 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009181 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009182
James Ketrenosb095c382005-08-24 22:04:42 -05009183 if (!wrqu->power.fixed)
9184 wrqu->power.value = IPW_TX_POWER_DEFAULT;
James Ketrenos43f66a62005-03-25 12:31:53 -06009185
James Ketrenosc848d0a2005-08-24 21:56:24 -05009186 if (wrqu->power.flags != IW_TXPOW_DBM) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009187 err = -EINVAL;
9188 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009189 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009190
James Ketrenosb095c382005-08-24 22:04:42 -05009191 if ((wrqu->power.value > IPW_TX_POWER_MAX) ||
James Ketrenosafbf30a2005-08-25 00:05:33 -05009192 (wrqu->power.value < IPW_TX_POWER_MIN)) {
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009193 err = -EINVAL;
9194 goto out;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009195 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009196
9197 priv->tx_power = wrqu->power.value;
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009198 err = ipw_set_tx_power(priv);
9199 out:
Zhu Yi46441512006-01-24 16:37:59 +08009200 mutex_unlock(&priv->mutex);
Zhu Yi6de9f7f2005-08-11 14:39:33 +08009201 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009202}
9203
Jeff Garzikbf794512005-07-31 13:07:26 -04009204static int ipw_wx_get_txpow(struct net_device *dev,
9205 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009206 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009207{
James Ketrenos43f66a62005-03-25 12:31:53 -06009208 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009209 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009210 wrqu->power.value = priv->tx_power;
9211 wrqu->power.fixed = 1;
9212 wrqu->power.flags = IW_TXPOW_DBM;
9213 wrqu->power.disabled = (priv->status & STATUS_RF_KILL_MASK) ? 1 : 0;
Zhu Yi46441512006-01-24 16:37:59 +08009214 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009215
Jeff Garzikbf794512005-07-31 13:07:26 -04009216 IPW_DEBUG_WX("GET TX Power -> %s %d \n",
Zhu Yi22501c82005-08-11 10:49:17 +08009217 wrqu->power.disabled ? "OFF" : "ON", wrqu->power.value);
James Ketrenos43f66a62005-03-25 12:31:53 -06009218
9219 return 0;
9220}
9221
Jeff Garzikbf794512005-07-31 13:07:26 -04009222static int ipw_wx_set_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009223 struct iw_request_info *info,
9224 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009225{
9226 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009227 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009228 if (wrqu->frag.disabled)
9229 priv->ieee->fts = DEFAULT_FTS;
9230 else {
9231 if (wrqu->frag.value < MIN_FRAG_THRESHOLD ||
James Ketrenosb095c382005-08-24 22:04:42 -05009232 wrqu->frag.value > MAX_FRAG_THRESHOLD) {
Zhu Yi46441512006-01-24 16:37:59 +08009233 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009234 return -EINVAL;
James Ketrenosb095c382005-08-24 22:04:42 -05009235 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009236
James Ketrenos43f66a62005-03-25 12:31:53 -06009237 priv->ieee->fts = wrqu->frag.value & ~0x1;
9238 }
9239
9240 ipw_send_frag_threshold(priv, wrqu->frag.value);
Zhu Yi46441512006-01-24 16:37:59 +08009241 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009242 IPW_DEBUG_WX("SET Frag Threshold -> %d \n", wrqu->frag.value);
9243 return 0;
9244}
9245
Jeff Garzikbf794512005-07-31 13:07:26 -04009246static int ipw_wx_get_frag(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009247 struct iw_request_info *info,
9248 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009249{
9250 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009251 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009252 wrqu->frag.value = priv->ieee->fts;
9253 wrqu->frag.fixed = 0; /* no auto select */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009254 wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FTS);
Zhu Yi46441512006-01-24 16:37:59 +08009255 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009256 IPW_DEBUG_WX("GET Frag Threshold -> %d \n", wrqu->frag.value);
9257
9258 return 0;
9259}
9260
Jeff Garzikbf794512005-07-31 13:07:26 -04009261static int ipw_wx_set_retry(struct net_device *dev,
9262 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009263 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009264{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009265 struct ipw_priv *priv = ieee80211_priv(dev);
9266
9267 if (wrqu->retry.flags & IW_RETRY_LIFETIME || wrqu->retry.disabled)
9268 return -EINVAL;
9269
9270 if (!(wrqu->retry.flags & IW_RETRY_LIMIT))
9271 return 0;
9272
Zhu Yid5f7ac22006-08-21 11:38:17 +08009273 if (wrqu->retry.value < 0 || wrqu->retry.value >= 255)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009274 return -EINVAL;
9275
Zhu Yi46441512006-01-24 16:37:59 +08009276 mutex_lock(&priv->mutex);
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009277 if (wrqu->retry.flags & IW_RETRY_SHORT)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009278 priv->short_retry_limit = (u8) wrqu->retry.value;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009279 else if (wrqu->retry.flags & IW_RETRY_LONG)
James Ketrenosafbf30a2005-08-25 00:05:33 -05009280 priv->long_retry_limit = (u8) wrqu->retry.value;
9281 else {
9282 priv->short_retry_limit = (u8) wrqu->retry.value;
9283 priv->long_retry_limit = (u8) wrqu->retry.value;
9284 }
9285
9286 ipw_send_retry_limit(priv, priv->short_retry_limit,
9287 priv->long_retry_limit);
Zhu Yi46441512006-01-24 16:37:59 +08009288 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009289 IPW_DEBUG_WX("SET retry limit -> short:%d long:%d\n",
9290 priv->short_retry_limit, priv->long_retry_limit);
9291 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009292}
9293
Jeff Garzikbf794512005-07-31 13:07:26 -04009294static int ipw_wx_get_retry(struct net_device *dev,
9295 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009296 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009297{
James Ketrenosafbf30a2005-08-25 00:05:33 -05009298 struct ipw_priv *priv = ieee80211_priv(dev);
9299
Zhu Yi46441512006-01-24 16:37:59 +08009300 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009301 wrqu->retry.disabled = 0;
9302
9303 if ((wrqu->retry.flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
Zhu Yi46441512006-01-24 16:37:59 +08009304 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009305 return -EINVAL;
9306 }
9307
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009308 if (wrqu->retry.flags & IW_RETRY_LONG) {
9309 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009310 wrqu->retry.value = priv->long_retry_limit;
Jean Tourrilhes919ee6d2006-08-29 18:01:40 -07009311 } else if (wrqu->retry.flags & IW_RETRY_SHORT) {
9312 wrqu->retry.flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009313 wrqu->retry.value = priv->short_retry_limit;
9314 } else {
9315 wrqu->retry.flags = IW_RETRY_LIMIT;
9316 wrqu->retry.value = priv->short_retry_limit;
9317 }
Zhu Yi46441512006-01-24 16:37:59 +08009318 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009319
9320 IPW_DEBUG_WX("GET retry -> %d \n", wrqu->retry.value);
9321
9322 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009323}
9324
James Ketrenosafbf30a2005-08-25 00:05:33 -05009325static int ipw_request_direct_scan(struct ipw_priv *priv, char *essid,
9326 int essid_len)
9327{
9328 struct ipw_scan_request_ext scan;
9329 int err = 0, scan_type;
9330
Pekka Enbergefb34422005-11-16 21:55:05 +02009331 if (!(priv->status & STATUS_INIT) ||
9332 (priv->status & STATUS_EXIT_PENDING))
9333 return 0;
9334
Zhu Yi46441512006-01-24 16:37:59 +08009335 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009336
9337 if (priv->status & STATUS_RF_KILL_MASK) {
9338 IPW_DEBUG_HC("Aborting scan due to RF kill activation\n");
9339 priv->status |= STATUS_SCAN_PENDING;
9340 goto done;
9341 }
9342
9343 IPW_DEBUG_HC("starting request direct scan!\n");
9344
9345 if (priv->status & (STATUS_SCANNING | STATUS_SCAN_ABORTING)) {
Olaf Kirchd834a412006-01-09 17:00:37 +01009346 /* We should not sleep here; otherwise we will block most
9347 * of the system (for instance, we hold rtnl_lock when we
9348 * get here).
9349 */
9350 err = -EAGAIN;
9351 goto done;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009352 }
9353 memset(&scan, 0, sizeof(scan));
9354
9355 if (priv->config & CFG_SPEED_SCAN)
9356 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9357 cpu_to_le16(30);
9358 else
9359 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_SCAN] =
9360 cpu_to_le16(20);
9361
9362 scan.dwell_time[IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN] =
9363 cpu_to_le16(20);
Liu Hong1fe0adb2005-08-19 09:33:10 -05009364 scan.dwell_time[IPW_SCAN_PASSIVE_FULL_DWELL_SCAN] = cpu_to_le16(120);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009365 scan.dwell_time[IPW_SCAN_ACTIVE_DIRECT_SCAN] = cpu_to_le16(20);
9366
9367 scan.full_scan_index = cpu_to_le32(ieee80211_get_scans(priv->ieee));
9368
9369 err = ipw_send_ssid(priv, essid, essid_len);
9370 if (err) {
9371 IPW_DEBUG_HC("Attempt to send SSID command failed\n");
9372 goto done;
9373 }
9374 scan_type = IPW_SCAN_ACTIVE_BROADCAST_AND_DIRECT_SCAN;
9375
9376 ipw_add_scan_channels(priv, &scan, scan_type);
9377
9378 err = ipw_send_scan_request_ext(priv, &scan);
9379 if (err) {
9380 IPW_DEBUG_HC("Sending scan command failed: %08X\n", err);
9381 goto done;
9382 }
9383
9384 priv->status |= STATUS_SCANNING;
9385
9386 done:
Zhu Yi46441512006-01-24 16:37:59 +08009387 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009388 return err;
James Ketrenos43f66a62005-03-25 12:31:53 -06009389}
9390
Jeff Garzikbf794512005-07-31 13:07:26 -04009391static int ipw_wx_set_scan(struct net_device *dev,
9392 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009393 union iwreq_data *wrqu, char *extra)
9394{
9395 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi094c4d22006-08-21 11:39:03 +08009396 struct iw_scan_req *req = (struct iw_scan_req *)extra;
9397
9398 if (wrqu->data.length == sizeof(struct iw_scan_req)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -05009399 if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
9400 ipw_request_direct_scan(priv, req->essid,
9401 req->essid_len);
9402 return 0;
9403 }
Zhu Yi094c4d22006-08-21 11:39:03 +08009404 if (req->scan_type == IW_SCAN_TYPE_PASSIVE) {
9405 queue_work(priv->workqueue,
9406 &priv->request_passive_scan);
9407 return 0;
9408 }
James Ketrenosafbf30a2005-08-25 00:05:33 -05009409 }
James Ketrenos8935f392005-10-05 15:59:08 -05009410
James Ketrenos43f66a62005-03-25 12:31:53 -06009411 IPW_DEBUG_WX("Start scan\n");
James Ketrenosb095c382005-08-24 22:04:42 -05009412
9413 queue_work(priv->workqueue, &priv->request_scan);
9414
James Ketrenos43f66a62005-03-25 12:31:53 -06009415 return 0;
9416}
9417
Jeff Garzikbf794512005-07-31 13:07:26 -04009418static int ipw_wx_get_scan(struct net_device *dev,
9419 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009420 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009421{
James Ketrenos43f66a62005-03-25 12:31:53 -06009422 struct ipw_priv *priv = ieee80211_priv(dev);
9423 return ieee80211_wx_get_scan(priv->ieee, info, wrqu, extra);
9424}
9425
Jeff Garzikbf794512005-07-31 13:07:26 -04009426static int ipw_wx_set_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009427 struct iw_request_info *info,
9428 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009429{
9430 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009431 int ret;
Hong Liucaeff812005-08-05 17:25:50 +08009432 u32 cap = priv->capability;
James Ketrenosafbf30a2005-08-25 00:05:33 -05009433
Zhu Yi46441512006-01-24 16:37:59 +08009434 mutex_lock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009435 ret = ieee80211_wx_set_encode(priv->ieee, info, wrqu, key);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009436
Hong Liucaeff812005-08-05 17:25:50 +08009437 /* In IBSS mode, we need to notify the firmware to update
9438 * the beacon info after we changed the capability. */
9439 if (cap != priv->capability &&
9440 priv->ieee->iw_mode == IW_MODE_ADHOC &&
9441 priv->status & STATUS_ASSOCIATED)
9442 ipw_disassociate(priv);
9443
Zhu Yi46441512006-01-24 16:37:59 +08009444 mutex_unlock(&priv->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009445 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -06009446}
9447
Jeff Garzikbf794512005-07-31 13:07:26 -04009448static int ipw_wx_get_encode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009449 struct iw_request_info *info,
9450 union iwreq_data *wrqu, char *key)
James Ketrenos43f66a62005-03-25 12:31:53 -06009451{
9452 struct ipw_priv *priv = ieee80211_priv(dev);
9453 return ieee80211_wx_get_encode(priv->ieee, info, wrqu, key);
9454}
9455
Jeff Garzikbf794512005-07-31 13:07:26 -04009456static int ipw_wx_set_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009457 struct iw_request_info *info,
9458 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009459{
9460 struct ipw_priv *priv = ieee80211_priv(dev);
9461 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009462 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009463 if (wrqu->power.disabled) {
9464 priv->power_mode = IPW_POWER_LEVEL(priv->power_mode);
9465 err = ipw_send_power_mode(priv, IPW_POWER_MODE_CAM);
9466 if (err) {
9467 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009468 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009469 return err;
9470 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009471 IPW_DEBUG_WX("SET Power Management Mode -> off\n");
Zhu Yi46441512006-01-24 16:37:59 +08009472 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009473 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009474 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009475
9476 switch (wrqu->power.flags & IW_POWER_MODE) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009477 case IW_POWER_ON: /* If not specified */
9478 case IW_POWER_MODE: /* If set all mask */
9479 case IW_POWER_ALL_R: /* If explicitely state all */
James Ketrenos43f66a62005-03-25 12:31:53 -06009480 break;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009481 default: /* Otherwise we don't support it */
James Ketrenos43f66a62005-03-25 12:31:53 -06009482 IPW_DEBUG_WX("SET PM Mode: %X not supported.\n",
9483 wrqu->power.flags);
Zhu Yi46441512006-01-24 16:37:59 +08009484 mutex_unlock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -04009485 return -EOPNOTSUPP;
James Ketrenos43f66a62005-03-25 12:31:53 -06009486 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009487
James Ketrenos43f66a62005-03-25 12:31:53 -06009488 /* If the user hasn't specified a power management mode yet, default
9489 * to BATTERY */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009490 if (IPW_POWER_LEVEL(priv->power_mode) == IPW_POWER_AC)
James Ketrenos43f66a62005-03-25 12:31:53 -06009491 priv->power_mode = IPW_POWER_ENABLED | IPW_POWER_BATTERY;
Jeff Garzikbf794512005-07-31 13:07:26 -04009492 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009493 priv->power_mode = IPW_POWER_ENABLED | priv->power_mode;
9494 err = ipw_send_power_mode(priv, IPW_POWER_LEVEL(priv->power_mode));
9495 if (err) {
9496 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009497 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009498 return err;
9499 }
9500
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009501 IPW_DEBUG_WX("SET Power Management Mode -> 0x%02X\n", priv->power_mode);
Zhu Yi46441512006-01-24 16:37:59 +08009502 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009503 return 0;
9504}
9505
Jeff Garzikbf794512005-07-31 13:07:26 -04009506static int ipw_wx_get_power(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009507 struct iw_request_info *info,
9508 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009509{
9510 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009511 mutex_lock(&priv->mutex);
James Ketrenosa613bff2005-08-24 21:43:11 -05009512 if (!(priv->power_mode & IPW_POWER_ENABLED))
James Ketrenos43f66a62005-03-25 12:31:53 -06009513 wrqu->power.disabled = 1;
James Ketrenosa613bff2005-08-24 21:43:11 -05009514 else
James Ketrenos43f66a62005-03-25 12:31:53 -06009515 wrqu->power.disabled = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009516
Zhu Yi46441512006-01-24 16:37:59 +08009517 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009518 IPW_DEBUG_WX("GET Power Management Mode -> %02X\n", priv->power_mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009519
James Ketrenos43f66a62005-03-25 12:31:53 -06009520 return 0;
9521}
9522
Jeff Garzikbf794512005-07-31 13:07:26 -04009523static int ipw_wx_set_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009524 struct iw_request_info *info,
9525 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009526{
9527 struct ipw_priv *priv = ieee80211_priv(dev);
9528 int mode = *(int *)extra;
9529 int err;
Zhu Yi46441512006-01-24 16:37:59 +08009530 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009531 if ((mode < 1) || (mode > IPW_POWER_LIMIT)) {
9532 mode = IPW_POWER_AC;
9533 priv->power_mode = mode;
9534 } else {
9535 priv->power_mode = IPW_POWER_ENABLED | mode;
9536 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009537
James Ketrenos43f66a62005-03-25 12:31:53 -06009538 if (priv->power_mode != mode) {
9539 err = ipw_send_power_mode(priv, mode);
Jeff Garzikbf794512005-07-31 13:07:26 -04009540
James Ketrenos43f66a62005-03-25 12:31:53 -06009541 if (err) {
9542 IPW_DEBUG_WX("failed setting power mode.\n");
Zhu Yi46441512006-01-24 16:37:59 +08009543 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009544 return err;
9545 }
9546 }
Zhu Yi46441512006-01-24 16:37:59 +08009547 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009548 return 0;
9549}
9550
9551#define MAX_WX_STRING 80
Jeff Garzikbf794512005-07-31 13:07:26 -04009552static int ipw_wx_get_powermode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009553 struct iw_request_info *info,
9554 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009555{
9556 struct ipw_priv *priv = ieee80211_priv(dev);
9557 int level = IPW_POWER_LEVEL(priv->power_mode);
9558 char *p = extra;
9559
9560 p += snprintf(p, MAX_WX_STRING, "Power save level: %d ", level);
9561
9562 switch (level) {
9563 case IPW_POWER_AC:
9564 p += snprintf(p, MAX_WX_STRING - (p - extra), "(AC)");
9565 break;
9566 case IPW_POWER_BATTERY:
9567 p += snprintf(p, MAX_WX_STRING - (p - extra), "(BATTERY)");
9568 break;
9569 default:
9570 p += snprintf(p, MAX_WX_STRING - (p - extra),
Jeff Garzikbf794512005-07-31 13:07:26 -04009571 "(Timeout %dms, Period %dms)",
James Ketrenos43f66a62005-03-25 12:31:53 -06009572 timeout_duration[level - 1] / 1000,
9573 period_duration[level - 1] / 1000);
9574 }
9575
9576 if (!(priv->power_mode & IPW_POWER_ENABLED))
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009577 p += snprintf(p, MAX_WX_STRING - (p - extra), " OFF");
James Ketrenos43f66a62005-03-25 12:31:53 -06009578
9579 wrqu->data.length = p - extra + 1;
9580
9581 return 0;
9582}
9583
9584static int ipw_wx_set_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009585 struct iw_request_info *info,
9586 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009587{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009588 struct ipw_priv *priv = ieee80211_priv(dev);
James Ketrenos43f66a62005-03-25 12:31:53 -06009589 int mode = *(int *)extra;
9590 u8 band = 0, modulation = 0;
9591
9592 if (mode == 0 || mode & ~IEEE_MODE_MASK) {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009593 IPW_WARNING("Attempt to set invalid wireless mode: %d\n", mode);
James Ketrenos43f66a62005-03-25 12:31:53 -06009594 return -EINVAL;
9595 }
Zhu Yi46441512006-01-24 16:37:59 +08009596 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009597 if (priv->adapter == IPW_2915ABG) {
James Ketrenosa33a1982005-09-14 14:28:59 -05009598 priv->ieee->abg_true = 1;
James Ketrenos43f66a62005-03-25 12:31:53 -06009599 if (mode & IEEE_A) {
9600 band |= IEEE80211_52GHZ_BAND;
9601 modulation |= IEEE80211_OFDM_MODULATION;
9602 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009603 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009604 } else {
9605 if (mode & IEEE_A) {
9606 IPW_WARNING("Attempt to set 2200BG into "
9607 "802.11a mode\n");
Zhu Yi46441512006-01-24 16:37:59 +08009608 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009609 return -EINVAL;
9610 }
9611
James Ketrenosa33a1982005-09-14 14:28:59 -05009612 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009613 }
9614
9615 if (mode & IEEE_B) {
9616 band |= IEEE80211_24GHZ_BAND;
9617 modulation |= IEEE80211_CCK_MODULATION;
9618 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009619 priv->ieee->abg_true = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -04009620
James Ketrenos43f66a62005-03-25 12:31:53 -06009621 if (mode & IEEE_G) {
9622 band |= IEEE80211_24GHZ_BAND;
9623 modulation |= IEEE80211_OFDM_MODULATION;
9624 } else
James Ketrenosa33a1982005-09-14 14:28:59 -05009625 priv->ieee->abg_true = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009626
9627 priv->ieee->mode = mode;
9628 priv->ieee->freq_band = band;
9629 priv->ieee->modulation = modulation;
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009630 init_supported_rates(priv, &priv->rates);
James Ketrenos43f66a62005-03-25 12:31:53 -06009631
James Ketrenosc848d0a2005-08-24 21:56:24 -05009632 /* Network configuration changed -- force [re]association */
9633 IPW_DEBUG_ASSOC("[re]association triggered due to mode change.\n");
9634 if (!ipw_disassociate(priv)) {
James Ketrenos43f66a62005-03-25 12:31:53 -06009635 ipw_send_supported_rates(priv, &priv->rates);
James Ketrenosc848d0a2005-08-24 21:56:24 -05009636 ipw_associate(priv);
9637 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009638
James Ketrenosa613bff2005-08-24 21:43:11 -05009639 /* Update the band LEDs */
9640 ipw_led_band_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -06009641
Jeff Garzikbf794512005-07-31 13:07:26 -04009642 IPW_DEBUG_WX("PRIV SET MODE: %c%c%c\n",
James Ketrenos43f66a62005-03-25 12:31:53 -06009643 mode & IEEE_A ? 'a' : '.',
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009644 mode & IEEE_B ? 'b' : '.', mode & IEEE_G ? 'g' : '.');
Zhu Yi46441512006-01-24 16:37:59 +08009645 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009646 return 0;
9647}
9648
9649static int ipw_wx_get_wireless_mode(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009650 struct iw_request_info *info,
9651 union iwreq_data *wrqu, char *extra)
James Ketrenos43f66a62005-03-25 12:31:53 -06009652{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009653 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009654 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009655 switch (priv->ieee->mode) {
9656 case IEEE_A:
James Ketrenos43f66a62005-03-25 12:31:53 -06009657 strncpy(extra, "802.11a (1)", MAX_WX_STRING);
9658 break;
James Ketrenosea2b26e2005-08-24 21:25:16 -05009659 case IEEE_B:
9660 strncpy(extra, "802.11b (2)", MAX_WX_STRING);
9661 break;
9662 case IEEE_A | IEEE_B:
9663 strncpy(extra, "802.11ab (3)", MAX_WX_STRING);
9664 break;
9665 case IEEE_G:
9666 strncpy(extra, "802.11g (4)", MAX_WX_STRING);
9667 break;
9668 case IEEE_A | IEEE_G:
9669 strncpy(extra, "802.11ag (5)", MAX_WX_STRING);
9670 break;
9671 case IEEE_B | IEEE_G:
9672 strncpy(extra, "802.11bg (6)", MAX_WX_STRING);
9673 break;
9674 case IEEE_A | IEEE_B | IEEE_G:
9675 strncpy(extra, "802.11abg (7)", MAX_WX_STRING);
9676 break;
9677 default:
9678 strncpy(extra, "unknown", MAX_WX_STRING);
James Ketrenos43f66a62005-03-25 12:31:53 -06009679 break;
Jeff Garzikbf794512005-07-31 13:07:26 -04009680 }
9681
James Ketrenos43f66a62005-03-25 12:31:53 -06009682 IPW_DEBUG_WX("PRIV GET MODE: %s\n", extra);
9683
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009684 wrqu->data.length = strlen(extra) + 1;
Zhu Yi46441512006-01-24 16:37:59 +08009685 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009686
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009687 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009688}
9689
James Ketrenosea2b26e2005-08-24 21:25:16 -05009690static int ipw_wx_set_preamble(struct net_device *dev,
9691 struct iw_request_info *info,
9692 union iwreq_data *wrqu, char *extra)
9693{
9694 struct ipw_priv *priv = ieee80211_priv(dev);
9695 int mode = *(int *)extra;
Zhu Yi46441512006-01-24 16:37:59 +08009696 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009697 /* Switching from SHORT -> LONG requires a disassociation */
9698 if (mode == 1) {
9699 if (!(priv->config & CFG_PREAMBLE_LONG)) {
9700 priv->config |= CFG_PREAMBLE_LONG;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009701
9702 /* Network configuration changed -- force [re]association */
9703 IPW_DEBUG_ASSOC
9704 ("[re]association triggered due to preamble change.\n");
9705 if (!ipw_disassociate(priv))
9706 ipw_associate(priv);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009707 }
9708 goto done;
9709 }
9710
9711 if (mode == 0) {
9712 priv->config &= ~CFG_PREAMBLE_LONG;
9713 goto done;
9714 }
Zhu Yi46441512006-01-24 16:37:59 +08009715 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009716 return -EINVAL;
9717
9718 done:
Zhu Yi46441512006-01-24 16:37:59 +08009719 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009720 return 0;
9721}
9722
9723static int ipw_wx_get_preamble(struct net_device *dev,
9724 struct iw_request_info *info,
9725 union iwreq_data *wrqu, char *extra)
9726{
9727 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +08009728 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009729 if (priv->config & CFG_PREAMBLE_LONG)
9730 snprintf(wrqu->name, IFNAMSIZ, "long (1)");
9731 else
9732 snprintf(wrqu->name, IFNAMSIZ, "auto (0)");
Zhu Yi46441512006-01-24 16:37:59 +08009733 mutex_unlock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009734 return 0;
9735}
9736
James Ketrenosb095c382005-08-24 22:04:42 -05009737#ifdef CONFIG_IPW2200_MONITOR
James Ketrenosea2b26e2005-08-24 21:25:16 -05009738static int ipw_wx_set_monitor(struct net_device *dev,
Jeff Garzikbf794512005-07-31 13:07:26 -04009739 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009740 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009741{
James Ketrenos43f66a62005-03-25 12:31:53 -06009742 struct ipw_priv *priv = ieee80211_priv(dev);
9743 int *parms = (int *)extra;
9744 int enable = (parms[0] > 0);
Zhu Yi46441512006-01-24 16:37:59 +08009745 mutex_lock(&priv->mutex);
James Ketrenosea2b26e2005-08-24 21:25:16 -05009746 IPW_DEBUG_WX("SET MONITOR: %d %d\n", enable, parms[1]);
James Ketrenos43f66a62005-03-25 12:31:53 -06009747 if (enable) {
9748 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi459d4082006-04-13 17:21:00 +08009749#ifdef CONFIG_IPW2200_RADIOTAP
Mike Kershaw24a47db2005-08-26 00:41:54 -05009750 priv->net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
9751#else
James Ketrenos43f66a62005-03-25 12:31:53 -06009752 priv->net_dev->type = ARPHRD_IEEE80211;
Mike Kershaw24a47db2005-08-26 00:41:54 -05009753#endif
James Ketrenosa613bff2005-08-24 21:43:11 -05009754 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009755 }
Jeff Garzikbf794512005-07-31 13:07:26 -04009756
James Ketrenos43f66a62005-03-25 12:31:53 -06009757 ipw_set_channel(priv, parms[1]);
9758 } else {
James Ketrenosc848d0a2005-08-24 21:56:24 -05009759 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
Zhu Yi46441512006-01-24 16:37:59 +08009760 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009761 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -05009762 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009763 priv->net_dev->type = ARPHRD_ETHER;
James Ketrenosa613bff2005-08-24 21:43:11 -05009764 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009765 }
Zhu Yi46441512006-01-24 16:37:59 +08009766 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -06009767 return 0;
9768}
9769
Pavel Machek67fd6b42006-07-11 15:34:05 +02009770#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenosb095c382005-08-24 22:04:42 -05009771
Jeff Garzikbf794512005-07-31 13:07:26 -04009772static int ipw_wx_reset(struct net_device *dev,
9773 struct iw_request_info *info,
James Ketrenos43f66a62005-03-25 12:31:53 -06009774 union iwreq_data *wrqu, char *extra)
Jeff Garzikbf794512005-07-31 13:07:26 -04009775{
James Ketrenos43f66a62005-03-25 12:31:53 -06009776 struct ipw_priv *priv = ieee80211_priv(dev);
9777 IPW_DEBUG_WX("RESET\n");
James Ketrenosa613bff2005-08-24 21:43:11 -05009778 queue_work(priv->workqueue, &priv->adapter_restart);
James Ketrenos43f66a62005-03-25 12:31:53 -06009779 return 0;
9780}
James Ketrenosb095c382005-08-24 22:04:42 -05009781
James Ketrenosb095c382005-08-24 22:04:42 -05009782static int ipw_wx_sw_reset(struct net_device *dev,
9783 struct iw_request_info *info,
9784 union iwreq_data *wrqu, char *extra)
9785{
9786 struct ipw_priv *priv = ieee80211_priv(dev);
9787 union iwreq_data wrqu_sec = {
9788 .encoding = {
9789 .flags = IW_ENCODE_DISABLED,
9790 },
9791 };
James Ketrenosafbf30a2005-08-25 00:05:33 -05009792 int ret;
James Ketrenosb095c382005-08-24 22:04:42 -05009793
9794 IPW_DEBUG_WX("SW_RESET\n");
9795
Zhu Yi46441512006-01-24 16:37:59 +08009796 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009797
Zhu Yid6d5b5c2006-02-16 16:21:09 +08009798 ret = ipw_sw_reset(priv, 2);
James Ketrenosafbf30a2005-08-25 00:05:33 -05009799 if (!ret) {
9800 free_firmware();
9801 ipw_adapter_restart(priv);
9802 }
James Ketrenosb095c382005-08-24 22:04:42 -05009803
9804 /* The SW reset bit might have been toggled on by the 'disable'
9805 * module parameter, so take appropriate action */
9806 ipw_radio_kill_sw(priv, priv->status & STATUS_RF_KILL_SW);
9807
Zhu Yi46441512006-01-24 16:37:59 +08009808 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009809 ieee80211_wx_set_encode(priv->ieee, info, &wrqu_sec, NULL);
Zhu Yi46441512006-01-24 16:37:59 +08009810 mutex_lock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009811
9812 if (!(priv->status & STATUS_RF_KILL_MASK)) {
9813 /* Configuration likely changed -- force [re]association */
9814 IPW_DEBUG_ASSOC("[re]association triggered due to sw "
9815 "reset.\n");
9816 if (!ipw_disassociate(priv))
9817 ipw_associate(priv);
9818 }
9819
Zhu Yi46441512006-01-24 16:37:59 +08009820 mutex_unlock(&priv->mutex);
James Ketrenosb095c382005-08-24 22:04:42 -05009821
9822 return 0;
9823}
James Ketrenos43f66a62005-03-25 12:31:53 -06009824
9825/* Rebase the WE IOCTLs to zero for the handler array */
9826#define IW_IOCTL(x) [(x)-SIOCSIWCOMMIT]
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009827static iw_handler ipw_wx_handlers[] = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009828 IW_IOCTL(SIOCGIWNAME) = ipw_wx_get_name,
9829 IW_IOCTL(SIOCSIWFREQ) = ipw_wx_set_freq,
9830 IW_IOCTL(SIOCGIWFREQ) = ipw_wx_get_freq,
9831 IW_IOCTL(SIOCSIWMODE) = ipw_wx_set_mode,
9832 IW_IOCTL(SIOCGIWMODE) = ipw_wx_get_mode,
Olivier Hochreutiner651be262006-03-08 03:13:55 +08009833 IW_IOCTL(SIOCSIWSENS) = ipw_wx_set_sens,
9834 IW_IOCTL(SIOCGIWSENS) = ipw_wx_get_sens,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009835 IW_IOCTL(SIOCGIWRANGE) = ipw_wx_get_range,
9836 IW_IOCTL(SIOCSIWAP) = ipw_wx_set_wap,
9837 IW_IOCTL(SIOCGIWAP) = ipw_wx_get_wap,
9838 IW_IOCTL(SIOCSIWSCAN) = ipw_wx_set_scan,
9839 IW_IOCTL(SIOCGIWSCAN) = ipw_wx_get_scan,
9840 IW_IOCTL(SIOCSIWESSID) = ipw_wx_set_essid,
9841 IW_IOCTL(SIOCGIWESSID) = ipw_wx_get_essid,
9842 IW_IOCTL(SIOCSIWNICKN) = ipw_wx_set_nick,
9843 IW_IOCTL(SIOCGIWNICKN) = ipw_wx_get_nick,
9844 IW_IOCTL(SIOCSIWRATE) = ipw_wx_set_rate,
9845 IW_IOCTL(SIOCGIWRATE) = ipw_wx_get_rate,
9846 IW_IOCTL(SIOCSIWRTS) = ipw_wx_set_rts,
9847 IW_IOCTL(SIOCGIWRTS) = ipw_wx_get_rts,
9848 IW_IOCTL(SIOCSIWFRAG) = ipw_wx_set_frag,
9849 IW_IOCTL(SIOCGIWFRAG) = ipw_wx_get_frag,
9850 IW_IOCTL(SIOCSIWTXPOW) = ipw_wx_set_txpow,
9851 IW_IOCTL(SIOCGIWTXPOW) = ipw_wx_get_txpow,
9852 IW_IOCTL(SIOCSIWRETRY) = ipw_wx_set_retry,
9853 IW_IOCTL(SIOCGIWRETRY) = ipw_wx_get_retry,
9854 IW_IOCTL(SIOCSIWENCODE) = ipw_wx_set_encode,
9855 IW_IOCTL(SIOCGIWENCODE) = ipw_wx_get_encode,
9856 IW_IOCTL(SIOCSIWPOWER) = ipw_wx_set_power,
9857 IW_IOCTL(SIOCGIWPOWER) = ipw_wx_get_power,
James Ketrenosa613bff2005-08-24 21:43:11 -05009858 IW_IOCTL(SIOCSIWSPY) = iw_handler_set_spy,
9859 IW_IOCTL(SIOCGIWSPY) = iw_handler_get_spy,
9860 IW_IOCTL(SIOCSIWTHRSPY) = iw_handler_set_thrspy,
9861 IW_IOCTL(SIOCGIWTHRSPY) = iw_handler_get_thrspy,
James Ketrenosafbf30a2005-08-25 00:05:33 -05009862 IW_IOCTL(SIOCSIWGENIE) = ipw_wx_set_genie,
9863 IW_IOCTL(SIOCGIWGENIE) = ipw_wx_get_genie,
9864 IW_IOCTL(SIOCSIWMLME) = ipw_wx_set_mlme,
9865 IW_IOCTL(SIOCSIWAUTH) = ipw_wx_set_auth,
9866 IW_IOCTL(SIOCGIWAUTH) = ipw_wx_get_auth,
9867 IW_IOCTL(SIOCSIWENCODEEXT) = ipw_wx_set_encodeext,
9868 IW_IOCTL(SIOCGIWENCODEEXT) = ipw_wx_get_encodeext,
James Ketrenos43f66a62005-03-25 12:31:53 -06009869};
9870
James Ketrenosb095c382005-08-24 22:04:42 -05009871enum {
9872 IPW_PRIV_SET_POWER = SIOCIWFIRSTPRIV,
9873 IPW_PRIV_GET_POWER,
9874 IPW_PRIV_SET_MODE,
9875 IPW_PRIV_GET_MODE,
9876 IPW_PRIV_SET_PREAMBLE,
9877 IPW_PRIV_GET_PREAMBLE,
9878 IPW_PRIV_RESET,
9879 IPW_PRIV_SW_RESET,
9880#ifdef CONFIG_IPW2200_MONITOR
9881 IPW_PRIV_SET_MONITOR,
9882#endif
9883};
James Ketrenos43f66a62005-03-25 12:31:53 -06009884
Jeff Garzikbf794512005-07-31 13:07:26 -04009885static struct iw_priv_args ipw_priv_args[] = {
James Ketrenos43f66a62005-03-25 12:31:53 -06009886 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009887 .cmd = IPW_PRIV_SET_POWER,
9888 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9889 .name = "set_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009890 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009891 .cmd = IPW_PRIV_GET_POWER,
9892 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9893 .name = "get_power"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009894 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009895 .cmd = IPW_PRIV_SET_MODE,
9896 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9897 .name = "set_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009898 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009899 .cmd = IPW_PRIV_GET_MODE,
9900 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
9901 .name = "get_mode"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009902 {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009903 .cmd = IPW_PRIV_SET_PREAMBLE,
9904 .set_args = IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
9905 .name = "set_preamble"},
9906 {
9907 .cmd = IPW_PRIV_GET_PREAMBLE,
9908 .get_args = IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | IFNAMSIZ,
9909 .name = "get_preamble"},
James Ketrenos43f66a62005-03-25 12:31:53 -06009910 {
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009911 IPW_PRIV_RESET,
9912 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "reset"},
James Ketrenosb095c382005-08-24 22:04:42 -05009913 {
9914 IPW_PRIV_SW_RESET,
9915 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 0, 0, "sw_reset"},
9916#ifdef CONFIG_IPW2200_MONITOR
9917 {
9918 IPW_PRIV_SET_MONITOR,
9919 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "monitor"},
9920#endif /* CONFIG_IPW2200_MONITOR */
James Ketrenos43f66a62005-03-25 12:31:53 -06009921};
9922
9923static iw_handler ipw_priv_handler[] = {
9924 ipw_wx_set_powermode,
9925 ipw_wx_get_powermode,
9926 ipw_wx_set_wireless_mode,
9927 ipw_wx_get_wireless_mode,
James Ketrenosea2b26e2005-08-24 21:25:16 -05009928 ipw_wx_set_preamble,
9929 ipw_wx_get_preamble,
Jeff Garzikbf794512005-07-31 13:07:26 -04009930 ipw_wx_reset,
James Ketrenosb095c382005-08-24 22:04:42 -05009931 ipw_wx_sw_reset,
9932#ifdef CONFIG_IPW2200_MONITOR
9933 ipw_wx_set_monitor,
James Ketrenos43f66a62005-03-25 12:31:53 -06009934#endif
9935};
9936
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009937static struct iw_handler_def ipw_wx_handler_def = {
James Ketrenosea2b26e2005-08-24 21:25:16 -05009938 .standard = ipw_wx_handlers,
9939 .num_standard = ARRAY_SIZE(ipw_wx_handlers),
9940 .num_private = ARRAY_SIZE(ipw_priv_handler),
9941 .num_private_args = ARRAY_SIZE(ipw_priv_args),
9942 .private = ipw_priv_handler,
9943 .private_args = ipw_priv_args,
Benoit Boissinot97a78ca2005-09-15 17:30:28 +00009944 .get_wireless_stats = ipw_get_wireless_stats,
James Ketrenos43f66a62005-03-25 12:31:53 -06009945};
9946
James Ketrenos43f66a62005-03-25 12:31:53 -06009947/*
9948 * Get wireless statistics.
9949 * Called by /proc/net/wireless
9950 * Also called by SIOCGIWSTATS
9951 */
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009952static struct iw_statistics *ipw_get_wireless_stats(struct net_device *dev)
James Ketrenos43f66a62005-03-25 12:31:53 -06009953{
9954 struct ipw_priv *priv = ieee80211_priv(dev);
9955 struct iw_statistics *wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -04009956
James Ketrenos43f66a62005-03-25 12:31:53 -06009957 wstats = &priv->wstats;
9958
James Ketrenosea2b26e2005-08-24 21:25:16 -05009959 /* if hw is disabled, then ipw_get_ordinal() can't be called.
James Ketrenosafbf30a2005-08-25 00:05:33 -05009960 * netdev->get_wireless_stats seems to be called before fw is
James Ketrenos43f66a62005-03-25 12:31:53 -06009961 * initialized. STATUS_ASSOCIATED will only be set if the hw is up
9962 * and associated; if not associcated, the values are all meaningless
9963 * anyway, so set them all to NULL and INVALID */
9964 if (!(priv->status & STATUS_ASSOCIATED)) {
9965 wstats->miss.beacon = 0;
9966 wstats->discard.retries = 0;
9967 wstats->qual.qual = 0;
9968 wstats->qual.level = 0;
9969 wstats->qual.noise = 0;
9970 wstats->qual.updated = 7;
9971 wstats->qual.updated |= IW_QUAL_NOISE_INVALID |
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009972 IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
James Ketrenos43f66a62005-03-25 12:31:53 -06009973 return wstats;
Jeff Garzikbf794512005-07-31 13:07:26 -04009974 }
James Ketrenos43f66a62005-03-25 12:31:53 -06009975
9976 wstats->qual.qual = priv->quality;
Zhu Yi00d21de2006-04-13 17:19:02 +08009977 wstats->qual.level = priv->exp_avg_rssi;
9978 wstats->qual.noise = priv->exp_avg_noise;
James Ketrenos43f66a62005-03-25 12:31:53 -06009979 wstats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
Bill Mossb1916082006-02-15 08:50:18 +08009980 IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
James Ketrenos43f66a62005-03-25 12:31:53 -06009981
9982 wstats->miss.beacon = average_value(&priv->average_missed_beacons);
9983 wstats->discard.retries = priv->last_tx_failures;
9984 wstats->discard.code = priv->ieee->ieee_stats.rx_discards_undecryptable;
Jeff Garzikbf794512005-07-31 13:07:26 -04009985
James Ketrenos43f66a62005-03-25 12:31:53 -06009986/* if (ipw_get_ordinal(priv, IPW_ORD_STAT_TX_RETRY, &tx_retry, &len))
9987 goto fail_get_ordinal;
9988 wstats->discard.retries += tx_retry; */
Jeff Garzikbf794512005-07-31 13:07:26 -04009989
James Ketrenos43f66a62005-03-25 12:31:53 -06009990 return wstats;
9991}
9992
James Ketrenos43f66a62005-03-25 12:31:53 -06009993/* net device stuff */
9994
Arjan van de Ven858119e2006-01-14 13:20:43 -08009995static void init_sys_config(struct ipw_sys_config *sys_config)
James Ketrenos43f66a62005-03-25 12:31:53 -06009996{
Jeff Garzik0edd5b42005-09-07 00:48:31 -04009997 memset(sys_config, 0, sizeof(struct ipw_sys_config));
Zhu Yi810dabd2006-01-24 16:36:59 +08009998 sys_config->bt_coexistence = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -06009999 sys_config->answer_broadcast_ssid_probe = 0;
10000 sys_config->accept_all_data_frames = 0;
10001 sys_config->accept_non_directed_frames = 1;
10002 sys_config->exclude_unicast_unencrypted = 0;
10003 sys_config->disable_unicast_decryption = 1;
10004 sys_config->exclude_multicast_unencrypted = 0;
10005 sys_config->disable_multicast_decryption = 1;
Zhu Yid2b83e12006-04-13 17:19:36 +080010006 if (antenna < CFG_SYS_ANTENNA_BOTH || antenna > CFG_SYS_ANTENNA_B)
10007 antenna = CFG_SYS_ANTENNA_BOTH;
10008 sys_config->antenna_diversity = antenna;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010009 sys_config->pass_crc_to_host = 0; /* TODO: See if 1 gives us FCS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010010 sys_config->dot11g_auto_detection = 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010011 sys_config->enable_cts_to_self = 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010012 sys_config->bt_coexist_collision_thr = 0;
Pavel Machek67fd6b42006-07-11 15:34:05 +020010013 sys_config->pass_noise_stats_to_host = 1; /* 1 -- fix for 256 */
Cahill, Ben M12977152006-03-08 02:58:02 +080010014 sys_config->silence_threshold = 0x1e;
James Ketrenos43f66a62005-03-25 12:31:53 -060010015}
10016
10017static int ipw_net_open(struct net_device *dev)
10018{
10019 struct ipw_priv *priv = ieee80211_priv(dev);
10020 IPW_DEBUG_INFO("dev->open\n");
10021 /* we should be verifying the device is ready to be opened */
Zhu Yi46441512006-01-24 16:37:59 +080010022 mutex_lock(&priv->mutex);
Jeff Garzikbf794512005-07-31 13:07:26 -040010023 if (!(priv->status & STATUS_RF_KILL_MASK) &&
10024 (priv->status & STATUS_ASSOCIATED))
James Ketrenos43f66a62005-03-25 12:31:53 -060010025 netif_start_queue(dev);
Zhu Yi46441512006-01-24 16:37:59 +080010026 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010027 return 0;
10028}
10029
10030static int ipw_net_stop(struct net_device *dev)
10031{
10032 IPW_DEBUG_INFO("dev->close\n");
10033 netif_stop_queue(dev);
10034 return 0;
10035}
10036
10037/*
10038todo:
10039
10040modify to send one tfd per fragment instead of using chunking. otherwise
10041we need to heavily modify the ieee80211_skb_to_txb.
10042*/
10043
Arjan van de Ven858119e2006-01-14 13:20:43 -080010044static int ipw_tx_skb(struct ipw_priv *priv, struct ieee80211_txb *txb,
James Ketrenos227d2dc2005-07-28 16:25:55 -050010045 int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010046{
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010047 struct ieee80211_hdr_3addrqos *hdr = (struct ieee80211_hdr_3addrqos *)
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010048 txb->fragments[0]->data;
James Ketrenos43f66a62005-03-25 12:31:53 -060010049 int i = 0;
10050 struct tfd_frame *tfd;
Zhu Yie43e3c12006-04-13 17:20:45 +080010051#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010052 int tx_id = ipw_get_tx_queue_number(priv, pri);
10053 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10054#else
James Ketrenos43f66a62005-03-25 12:31:53 -060010055 struct clx2_tx_queue *txq = &priv->txq[0];
James Ketrenosb095c382005-08-24 22:04:42 -050010056#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060010057 struct clx2_queue *q = &txq->q;
10058 u8 id, hdr_len, unicast;
10059 u16 remaining_bytes;
James Ketrenosc848d0a2005-08-24 21:56:24 -050010060 int fc;
James Ketrenos43f66a62005-03-25 12:31:53 -060010061
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010062 hdr_len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
James Ketrenos43f66a62005-03-25 12:31:53 -060010063 switch (priv->ieee->iw_mode) {
10064 case IW_MODE_ADHOC:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010065 unicast = !is_multicast_ether_addr(hdr->addr1);
James Ketrenos43f66a62005-03-25 12:31:53 -060010066 id = ipw_find_station(priv, hdr->addr1);
10067 if (id == IPW_INVALID_STATION) {
10068 id = ipw_add_station(priv, hdr->addr1);
10069 if (id == IPW_INVALID_STATION) {
10070 IPW_WARNING("Attempt to send data to "
Jeff Garzikbf794512005-07-31 13:07:26 -040010071 "invalid cell: " MAC_FMT "\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010072 MAC_ARG(hdr->addr1));
10073 goto drop;
10074 }
10075 }
10076 break;
10077
10078 case IW_MODE_INFRA:
10079 default:
Stephen Hemminger3c190652006-01-03 15:27:38 -080010080 unicast = !is_multicast_ether_addr(hdr->addr3);
James Ketrenos43f66a62005-03-25 12:31:53 -060010081 id = 0;
10082 break;
10083 }
10084
10085 tfd = &txq->bd[q->first_empty];
10086 txq->txb[q->first_empty] = txb;
10087 memset(tfd, 0, sizeof(*tfd));
10088 tfd->u.data.station_number = id;
10089
10090 tfd->control_flags.message_type = TX_FRAME_TYPE;
10091 tfd->control_flags.control_bits = TFD_NEED_IRQ_MASK;
10092
10093 tfd->u.data.cmd_id = DINO_CMD_TX;
James Ketrenosa613bff2005-08-24 21:43:11 -050010094 tfd->u.data.len = cpu_to_le16(txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010095 remaining_bytes = txb->payload_size;
Jeff Garzikbf794512005-07-31 13:07:26 -040010096
James Ketrenos43f66a62005-03-25 12:31:53 -060010097 if (priv->assoc_request.ieee_mode == IPW_B_MODE)
James Ketrenosb095c382005-08-24 22:04:42 -050010098 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_CCK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010099 else
James Ketrenosb095c382005-08-24 22:04:42 -050010100 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_MODE_OFDM;
James Ketrenos43f66a62005-03-25 12:31:53 -060010101
James Ketrenosea2b26e2005-08-24 21:25:16 -050010102 if (priv->assoc_request.preamble_length == DCT_FLAG_SHORT_PREAMBLE)
10103 tfd->u.data.tx_flags |= DCT_FLAG_SHORT_PREAMBLE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010104
James Ketrenosc848d0a2005-08-24 21:56:24 -050010105 fc = le16_to_cpu(hdr->frame_ctl);
10106 hdr->frame_ctl = cpu_to_le16(fc & ~IEEE80211_FCTL_MOREFRAGS);
James Ketrenos43f66a62005-03-25 12:31:53 -060010107
10108 memcpy(&tfd->u.data.tfd.tfd_24.mchdr, hdr, hdr_len);
10109
James Ketrenosb095c382005-08-24 22:04:42 -050010110 if (likely(unicast))
10111 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10112
10113 if (txb->encrypted && !priv->ieee->host_encrypt) {
10114 switch (priv->ieee->sec.level) {
10115 case SEC_LEVEL_3:
10116 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010117 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010118 /* XXX: ACK flag must be set for CCMP even if it
10119 * is a multicast/broadcast packet, because CCMP
10120 * group communication encrypted by GTK is
10121 * actually done by the AP. */
10122 if (!unicast)
10123 tfd->u.data.tx_flags |= DCT_FLAG_ACK_REQD;
10124
10125 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10126 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_CCM;
10127 tfd->u.data.key_index = 0;
10128 tfd->u.data.key_index |= DCT_WEP_INDEX_USE_IMMEDIATE;
10129 break;
10130 case SEC_LEVEL_2:
10131 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010132 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010133 tfd->u.data.tx_flags &= ~DCT_FLAG_NO_WEP;
10134 tfd->u.data.tx_flags_ext |= DCT_FLAG_EXT_SECURITY_TKIP;
10135 tfd->u.data.key_index = DCT_WEP_INDEX_USE_IMMEDIATE;
10136 break;
10137 case SEC_LEVEL_1:
10138 tfd->u.data.tfd.tfd_24.mchdr.frame_ctl |=
Zhu Yi851ca262006-08-21 11:37:58 +080010139 cpu_to_le16(IEEE80211_FCTL_PROTECTED);
James Ketrenosb095c382005-08-24 22:04:42 -050010140 tfd->u.data.key_index = priv->ieee->tx_keyidx;
10141 if (priv->ieee->sec.key_sizes[priv->ieee->tx_keyidx] <=
10142 40)
10143 tfd->u.data.key_index |= DCT_WEP_KEY_64Bit;
10144 else
10145 tfd->u.data.key_index |= DCT_WEP_KEY_128Bit;
10146 break;
10147 case SEC_LEVEL_0:
10148 break;
10149 default:
10150 printk(KERN_ERR "Unknow security level %d\n",
10151 priv->ieee->sec.level);
10152 break;
10153 }
10154 } else
10155 /* No hardware encryption */
10156 tfd->u.data.tx_flags |= DCT_FLAG_NO_WEP;
10157
Zhu Yie43e3c12006-04-13 17:20:45 +080010158#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080010159 if (fc & IEEE80211_STYPE_QOS_DATA)
10160 ipw_qos_set_tx_queue_command(priv, pri, &(tfd->u.data));
Zhu Yie43e3c12006-04-13 17:20:45 +080010161#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050010162
James Ketrenos43f66a62005-03-25 12:31:53 -060010163 /* payload */
James Ketrenosa613bff2005-08-24 21:43:11 -050010164 tfd->u.data.num_chunks = cpu_to_le32(min((u8) (NUM_TFD_CHUNKS - 2),
10165 txb->nr_frags));
10166 IPW_DEBUG_FRAG("%i fragments being sent as %i chunks.\n",
10167 txb->nr_frags, le32_to_cpu(tfd->u.data.num_chunks));
10168 for (i = 0; i < le32_to_cpu(tfd->u.data.num_chunks); i++) {
10169 IPW_DEBUG_FRAG("Adding fragment %i of %i (%d bytes).\n",
10170 i, le32_to_cpu(tfd->u.data.num_chunks),
10171 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010172 IPW_DEBUG_TX("Dumping TX packet frag %i of %i (%d bytes):\n",
James Ketrenos43f66a62005-03-25 12:31:53 -060010173 i, tfd->u.data.num_chunks,
10174 txb->fragments[i]->len - hdr_len);
Jeff Garzikbf794512005-07-31 13:07:26 -040010175 printk_buf(IPW_DL_TX, txb->fragments[i]->data + hdr_len,
James Ketrenos43f66a62005-03-25 12:31:53 -060010176 txb->fragments[i]->len - hdr_len);
10177
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010178 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010179 cpu_to_le32(pci_map_single
10180 (priv->pci_dev,
10181 txb->fragments[i]->data + hdr_len,
10182 txb->fragments[i]->len - hdr_len,
10183 PCI_DMA_TODEVICE));
10184 tfd->u.data.chunk_len[i] =
10185 cpu_to_le16(txb->fragments[i]->len - hdr_len);
James Ketrenos43f66a62005-03-25 12:31:53 -060010186 }
10187
10188 if (i != txb->nr_frags) {
10189 struct sk_buff *skb;
10190 u16 remaining_bytes = 0;
10191 int j;
10192
10193 for (j = i; j < txb->nr_frags; j++)
10194 remaining_bytes += txb->fragments[j]->len - hdr_len;
10195
10196 printk(KERN_INFO "Trying to reallocate for %d bytes\n",
10197 remaining_bytes);
10198 skb = alloc_skb(remaining_bytes, GFP_ATOMIC);
10199 if (skb != NULL) {
James Ketrenosa613bff2005-08-24 21:43:11 -050010200 tfd->u.data.chunk_len[i] = cpu_to_le16(remaining_bytes);
James Ketrenos43f66a62005-03-25 12:31:53 -060010201 for (j = i; j < txb->nr_frags; j++) {
10202 int size = txb->fragments[j]->len - hdr_len;
James Ketrenosafbf30a2005-08-25 00:05:33 -050010203
James Ketrenos43f66a62005-03-25 12:31:53 -060010204 printk(KERN_INFO "Adding frag %d %d...\n",
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010205 j, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010206 memcpy(skb_put(skb, size),
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010207 txb->fragments[j]->data + hdr_len, size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010208 }
10209 dev_kfree_skb_any(txb->fragments[i]);
10210 txb->fragments[i] = skb;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010211 tfd->u.data.chunk_ptr[i] =
James Ketrenosa613bff2005-08-24 21:43:11 -050010212 cpu_to_le32(pci_map_single
10213 (priv->pci_dev, skb->data,
10214 tfd->u.data.chunk_len[i],
10215 PCI_DMA_TODEVICE));
10216
10217 tfd->u.data.num_chunks =
10218 cpu_to_le32(le32_to_cpu(tfd->u.data.num_chunks) +
10219 1);
Jeff Garzikbf794512005-07-31 13:07:26 -040010220 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010221 }
10222
10223 /* kick DMA */
10224 q->first_empty = ipw_queue_inc_wrap(q->first_empty, q->n_bd);
10225 ipw_write32(priv, q->reg_w, q->first_empty);
10226
James Ketrenosf6970142006-02-14 09:10:51 +080010227 if (ipw_queue_space(q) < q->high_mark)
10228 netif_stop_queue(priv->net_dev);
10229
James Ketrenos227d2dc2005-07-28 16:25:55 -050010230 return NETDEV_TX_OK;
James Ketrenos43f66a62005-03-25 12:31:53 -060010231
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010232 drop:
James Ketrenos43f66a62005-03-25 12:31:53 -060010233 IPW_DEBUG_DROP("Silently dropping Tx packet.\n");
10234 ieee80211_txb_free(txb);
James Ketrenos227d2dc2005-07-28 16:25:55 -050010235 return NETDEV_TX_OK;
10236}
10237
10238static int ipw_net_is_queue_full(struct net_device *dev, int pri)
10239{
10240 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yie43e3c12006-04-13 17:20:45 +080010241#ifdef CONFIG_IPW2200_QOS
James Ketrenos227d2dc2005-07-28 16:25:55 -050010242 int tx_id = ipw_get_tx_queue_number(priv, pri);
10243 struct clx2_tx_queue *txq = &priv->txq[tx_id];
10244#else
10245 struct clx2_tx_queue *txq = &priv->txq[0];
Zhu Yie43e3c12006-04-13 17:20:45 +080010246#endif /* CONFIG_IPW2200_QOS */
James Ketrenos227d2dc2005-07-28 16:25:55 -050010247
10248 if (ipw_queue_space(&txq->q) < txq->q.high_mark)
10249 return 1;
10250
10251 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060010252}
10253
Zhu Yid685b8c2006-04-13 17:20:27 +080010254#ifdef CONFIG_IPW2200_PROMISCUOUS
10255static void ipw_handle_promiscuous_tx(struct ipw_priv *priv,
10256 struct ieee80211_txb *txb)
10257{
10258 struct ieee80211_rx_stats dummystats;
10259 struct ieee80211_hdr *hdr;
10260 u8 n;
10261 u16 filter = priv->prom_priv->filter;
10262 int hdr_only = 0;
10263
10264 if (filter & IPW_PROM_NO_TX)
10265 return;
10266
10267 memset(&dummystats, 0, sizeof(dummystats));
10268
10269 /* Filtering of fragment chains is done agains the first fragment */
10270 hdr = (void *)txb->fragments[0]->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010271 if (ieee80211_is_management(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010272 if (filter & IPW_PROM_NO_MGMT)
10273 return;
10274 if (filter & IPW_PROM_MGMT_HEADER_ONLY)
10275 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010276 } else if (ieee80211_is_control(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010277 if (filter & IPW_PROM_NO_CTL)
10278 return;
10279 if (filter & IPW_PROM_CTL_HEADER_ONLY)
10280 hdr_only = 1;
Zhu Yi851ca262006-08-21 11:37:58 +080010281 } else if (ieee80211_is_data(le16_to_cpu(hdr->frame_ctl))) {
Zhu Yid685b8c2006-04-13 17:20:27 +080010282 if (filter & IPW_PROM_NO_DATA)
10283 return;
10284 if (filter & IPW_PROM_DATA_HEADER_ONLY)
10285 hdr_only = 1;
10286 }
10287
10288 for(n=0; n<txb->nr_frags; ++n) {
10289 struct sk_buff *src = txb->fragments[n];
10290 struct sk_buff *dst;
10291 struct ieee80211_radiotap_header *rt_hdr;
10292 int len;
10293
10294 if (hdr_only) {
10295 hdr = (void *)src->data;
Zhu Yi851ca262006-08-21 11:37:58 +080010296 len = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl));
Zhu Yid685b8c2006-04-13 17:20:27 +080010297 } else
10298 len = src->len;
10299
10300 dst = alloc_skb(
10301 len + IEEE80211_RADIOTAP_HDRLEN, GFP_ATOMIC);
10302 if (!dst) continue;
10303
10304 rt_hdr = (void *)skb_put(dst, sizeof(*rt_hdr));
10305
10306 rt_hdr->it_version = PKTHDR_RADIOTAP_VERSION;
10307 rt_hdr->it_pad = 0;
10308 rt_hdr->it_present = 0; /* after all, it's just an idea */
10309 rt_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL);
10310
10311 *(u16*)skb_put(dst, sizeof(u16)) = cpu_to_le16(
10312 ieee80211chan2mhz(priv->channel));
10313 if (priv->channel > 14) /* 802.11a */
10314 *(u16*)skb_put(dst, sizeof(u16)) =
10315 cpu_to_le16(IEEE80211_CHAN_OFDM |
10316 IEEE80211_CHAN_5GHZ);
10317 else if (priv->ieee->mode == IEEE_B) /* 802.11b */
10318 *(u16*)skb_put(dst, sizeof(u16)) =
10319 cpu_to_le16(IEEE80211_CHAN_CCK |
10320 IEEE80211_CHAN_2GHZ);
10321 else /* 802.11g */
10322 *(u16*)skb_put(dst, sizeof(u16)) =
10323 cpu_to_le16(IEEE80211_CHAN_OFDM |
10324 IEEE80211_CHAN_2GHZ);
10325
10326 rt_hdr->it_len = dst->len;
10327
10328 memcpy(skb_put(dst, len), src->data, len);
10329
10330 if (!ieee80211_rx(priv->prom_priv->ieee, dst, &dummystats))
10331 dev_kfree_skb_any(dst);
10332 }
10333}
10334#endif
10335
James Ketrenos43f66a62005-03-25 12:31:53 -060010336static int ipw_net_hard_start_xmit(struct ieee80211_txb *txb,
James Ketrenosc8d42d12005-09-21 12:23:43 -050010337 struct net_device *dev, int pri)
James Ketrenos43f66a62005-03-25 12:31:53 -060010338{
10339 struct ipw_priv *priv = ieee80211_priv(dev);
10340 unsigned long flags;
James Ketrenos227d2dc2005-07-28 16:25:55 -050010341 int ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010342
10343 IPW_DEBUG_TX("dev->xmit(%d bytes)\n", txb->payload_size);
James Ketrenos43f66a62005-03-25 12:31:53 -060010344 spin_lock_irqsave(&priv->lock, flags);
10345
10346 if (!(priv->status & STATUS_ASSOCIATED)) {
10347 IPW_DEBUG_INFO("Tx attempt while not associated.\n");
10348 priv->ieee->stats.tx_carrier_errors++;
10349 netif_stop_queue(dev);
10350 goto fail_unlock;
10351 }
10352
Zhu Yid685b8c2006-04-13 17:20:27 +080010353#ifdef CONFIG_IPW2200_PROMISCUOUS
10354 if (rtap_iface && netif_running(priv->prom_net_dev))
10355 ipw_handle_promiscuous_tx(priv, txb);
10356#endif
10357
James Ketrenos227d2dc2005-07-28 16:25:55 -050010358 ret = ipw_tx_skb(priv, txb, pri);
10359 if (ret == NETDEV_TX_OK)
10360 __ipw_led_activity_on(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010361 spin_unlock_irqrestore(&priv->lock, flags);
James Ketrenos43f66a62005-03-25 12:31:53 -060010362
James Ketrenos227d2dc2005-07-28 16:25:55 -050010363 return ret;
James Ketrenos43f66a62005-03-25 12:31:53 -060010364
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010365 fail_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010366 spin_unlock_irqrestore(&priv->lock, flags);
10367 return 1;
10368}
10369
10370static struct net_device_stats *ipw_net_get_stats(struct net_device *dev)
10371{
10372 struct ipw_priv *priv = ieee80211_priv(dev);
Jeff Garzikbf794512005-07-31 13:07:26 -040010373
James Ketrenos43f66a62005-03-25 12:31:53 -060010374 priv->ieee->stats.tx_packets = priv->tx_packets;
10375 priv->ieee->stats.rx_packets = priv->rx_packets;
10376 return &priv->ieee->stats;
10377}
10378
10379static void ipw_net_set_multicast_list(struct net_device *dev)
10380{
10381
10382}
10383
10384static int ipw_net_set_mac_address(struct net_device *dev, void *p)
10385{
10386 struct ipw_priv *priv = ieee80211_priv(dev);
10387 struct sockaddr *addr = p;
10388 if (!is_valid_ether_addr(addr->sa_data))
10389 return -EADDRNOTAVAIL;
Zhu Yi46441512006-01-24 16:37:59 +080010390 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010391 priv->config |= CFG_CUSTOM_MAC;
10392 memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN);
10393 printk(KERN_INFO "%s: Setting MAC to " MAC_FMT "\n",
10394 priv->net_dev->name, MAC_ARG(priv->mac_addr));
James Ketrenosa613bff2005-08-24 21:43:11 -050010395 queue_work(priv->workqueue, &priv->adapter_restart);
Zhu Yi46441512006-01-24 16:37:59 +080010396 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010397 return 0;
10398}
10399
Jeff Garzikbf794512005-07-31 13:07:26 -040010400static void ipw_ethtool_get_drvinfo(struct net_device *dev,
James Ketrenos43f66a62005-03-25 12:31:53 -060010401 struct ethtool_drvinfo *info)
10402{
10403 struct ipw_priv *p = ieee80211_priv(dev);
10404 char vers[64];
10405 char date[32];
10406 u32 len;
10407
10408 strcpy(info->driver, DRV_NAME);
10409 strcpy(info->version, DRV_VERSION);
10410
10411 len = sizeof(vers);
10412 ipw_get_ordinal(p, IPW_ORD_STAT_FW_VERSION, vers, &len);
10413 len = sizeof(date);
10414 ipw_get_ordinal(p, IPW_ORD_STAT_FW_DATE, date, &len);
10415
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010416 snprintf(info->fw_version, sizeof(info->fw_version), "%s (%s)",
James Ketrenos43f66a62005-03-25 12:31:53 -060010417 vers, date);
10418 strcpy(info->bus_info, pci_name(p->pci_dev));
James Ketrenosb095c382005-08-24 22:04:42 -050010419 info->eedump_len = IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010420}
10421
10422static u32 ipw_ethtool_get_link(struct net_device *dev)
10423{
10424 struct ipw_priv *priv = ieee80211_priv(dev);
10425 return (priv->status & STATUS_ASSOCIATED) != 0;
10426}
10427
10428static int ipw_ethtool_get_eeprom_len(struct net_device *dev)
10429{
James Ketrenosb095c382005-08-24 22:04:42 -050010430 return IPW_EEPROM_IMAGE_SIZE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010431}
10432
10433static int ipw_ethtool_get_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010434 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010435{
10436 struct ipw_priv *p = ieee80211_priv(dev);
10437
James Ketrenosb095c382005-08-24 22:04:42 -050010438 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010439 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010440 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010441 memcpy(bytes, &p->eeprom[eeprom->offset], eeprom->len);
Zhu Yi46441512006-01-24 16:37:59 +080010442 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010443 return 0;
10444}
10445
10446static int ipw_ethtool_set_eeprom(struct net_device *dev,
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010447 struct ethtool_eeprom *eeprom, u8 * bytes)
James Ketrenos43f66a62005-03-25 12:31:53 -060010448{
10449 struct ipw_priv *p = ieee80211_priv(dev);
10450 int i;
10451
James Ketrenosb095c382005-08-24 22:04:42 -050010452 if (eeprom->offset + eeprom->len > IPW_EEPROM_IMAGE_SIZE)
James Ketrenos43f66a62005-03-25 12:31:53 -060010453 return -EINVAL;
Zhu Yi46441512006-01-24 16:37:59 +080010454 mutex_lock(&p->mutex);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010455 memcpy(&p->eeprom[eeprom->offset], bytes, eeprom->len);
Adrian Bunk71e585f2006-03-11 04:42:58 +010010456 for (i = 0; i < IPW_EEPROM_IMAGE_SIZE; i++)
10457 ipw_write8(p, i + IPW_EEPROM_DATA, p->eeprom[i]);
Zhu Yi46441512006-01-24 16:37:59 +080010458 mutex_unlock(&p->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060010459 return 0;
10460}
10461
Jeff Garzik7282d492006-09-13 14:30:00 -040010462static const struct ethtool_ops ipw_ethtool_ops = {
James Ketrenosea2b26e2005-08-24 21:25:16 -050010463 .get_link = ipw_ethtool_get_link,
10464 .get_drvinfo = ipw_ethtool_get_drvinfo,
10465 .get_eeprom_len = ipw_ethtool_get_eeprom_len,
10466 .get_eeprom = ipw_ethtool_get_eeprom,
10467 .set_eeprom = ipw_ethtool_set_eeprom,
James Ketrenos43f66a62005-03-25 12:31:53 -060010468};
10469
David Howells7d12e782006-10-05 14:55:46 +010010470static irqreturn_t ipw_isr(int irq, void *data)
James Ketrenos43f66a62005-03-25 12:31:53 -060010471{
10472 struct ipw_priv *priv = data;
10473 u32 inta, inta_mask;
Jeff Garzikbf794512005-07-31 13:07:26 -040010474
James Ketrenos43f66a62005-03-25 12:31:53 -060010475 if (!priv)
10476 return IRQ_NONE;
10477
Zhu Yi89c318e2006-06-08 22:19:49 -070010478 spin_lock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010479
10480 if (!(priv->status & STATUS_INT_ENABLED)) {
10481 /* Shared IRQ */
10482 goto none;
10483 }
10484
James Ketrenosb095c382005-08-24 22:04:42 -050010485 inta = ipw_read32(priv, IPW_INTA_RW);
10486 inta_mask = ipw_read32(priv, IPW_INTA_MASK_R);
Jeff Garzikbf794512005-07-31 13:07:26 -040010487
James Ketrenos43f66a62005-03-25 12:31:53 -060010488 if (inta == 0xFFFFFFFF) {
10489 /* Hardware disappeared */
10490 IPW_WARNING("IRQ INTA == 0xFFFFFFFF\n");
10491 goto none;
10492 }
10493
James Ketrenosb095c382005-08-24 22:04:42 -050010494 if (!(inta & (IPW_INTA_MASK_ALL & inta_mask))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010495 /* Shared interrupt */
10496 goto none;
10497 }
10498
10499 /* tell the device to stop sending interrupts */
Zhu Yi89c318e2006-06-08 22:19:49 -070010500 __ipw_disable_interrupts(priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010501
James Ketrenos43f66a62005-03-25 12:31:53 -060010502 /* ack current interrupts */
James Ketrenosb095c382005-08-24 22:04:42 -050010503 inta &= (IPW_INTA_MASK_ALL & inta_mask);
10504 ipw_write32(priv, IPW_INTA_RW, inta);
Jeff Garzikbf794512005-07-31 13:07:26 -040010505
James Ketrenos43f66a62005-03-25 12:31:53 -060010506 /* Cache INTA value for our tasklet */
10507 priv->isr_inta = inta;
10508
10509 tasklet_schedule(&priv->irq_tasklet);
10510
Zhu Yi89c318e2006-06-08 22:19:49 -070010511 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010512
10513 return IRQ_HANDLED;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010514 none:
Zhu Yi89c318e2006-06-08 22:19:49 -070010515 spin_unlock(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060010516 return IRQ_NONE;
10517}
10518
10519static void ipw_rf_kill(void *adapter)
10520{
10521 struct ipw_priv *priv = adapter;
10522 unsigned long flags;
Jeff Garzikbf794512005-07-31 13:07:26 -040010523
James Ketrenos43f66a62005-03-25 12:31:53 -060010524 spin_lock_irqsave(&priv->lock, flags);
10525
10526 if (rf_kill_active(priv)) {
10527 IPW_DEBUG_RF_KILL("RF Kill active, rescheduling GPIO check\n");
10528 if (priv->workqueue)
10529 queue_delayed_work(priv->workqueue,
10530 &priv->rf_kill, 2 * HZ);
10531 goto exit_unlock;
10532 }
10533
10534 /* RF Kill is now disabled, so bring the device back up */
10535
10536 if (!(priv->status & STATUS_RF_KILL_MASK)) {
10537 IPW_DEBUG_RF_KILL("HW RF Kill no longer active, restarting "
10538 "device\n");
10539
10540 /* we can not do an adapter restart while inside an irq lock */
10541 queue_work(priv->workqueue, &priv->adapter_restart);
Jeff Garzikbf794512005-07-31 13:07:26 -040010542 } else
James Ketrenos43f66a62005-03-25 12:31:53 -060010543 IPW_DEBUG_RF_KILL("HW RF Kill deactivated. SW RF Kill still "
10544 "enabled\n");
10545
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010546 exit_unlock:
James Ketrenos43f66a62005-03-25 12:31:53 -060010547 spin_unlock_irqrestore(&priv->lock, flags);
10548}
10549
James Ketrenosc848d0a2005-08-24 21:56:24 -050010550static void ipw_bg_rf_kill(void *data)
10551{
10552 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010553 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010554 ipw_rf_kill(data);
Zhu Yi46441512006-01-24 16:37:59 +080010555 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010556}
10557
Adrian Bunka73e22b2006-01-21 01:39:42 +010010558static void ipw_link_up(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010559{
James Ketrenosafbf30a2005-08-25 00:05:33 -050010560 priv->last_seq_num = -1;
10561 priv->last_frag_num = -1;
10562 priv->last_packet_time = 0;
10563
James Ketrenosa613bff2005-08-24 21:43:11 -050010564 netif_carrier_on(priv->net_dev);
10565 if (netif_queue_stopped(priv->net_dev)) {
10566 IPW_DEBUG_NOTIF("waking queue\n");
10567 netif_wake_queue(priv->net_dev);
10568 } else {
10569 IPW_DEBUG_NOTIF("starting queue\n");
10570 netif_start_queue(priv->net_dev);
10571 }
10572
James Ketrenosc848d0a2005-08-24 21:56:24 -050010573 cancel_delayed_work(&priv->request_scan);
James Ketrenosa613bff2005-08-24 21:43:11 -050010574 ipw_reset_stats(priv);
10575 /* Ensure the rate is updated immediately */
10576 priv->last_rate = ipw_get_current_rate(priv);
10577 ipw_gather_stats(priv);
10578 ipw_led_link_up(priv);
10579 notify_wx_assoc_event(priv);
10580
10581 if (priv->config & CFG_BACKGROUND_SCAN)
10582 queue_delayed_work(priv->workqueue, &priv->request_scan, HZ);
10583}
10584
James Ketrenosc848d0a2005-08-24 21:56:24 -050010585static void ipw_bg_link_up(void *data)
10586{
10587 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010588 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010589 ipw_link_up(data);
Zhu Yi46441512006-01-24 16:37:59 +080010590 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010591}
10592
Adrian Bunka73e22b2006-01-21 01:39:42 +010010593static void ipw_link_down(struct ipw_priv *priv)
James Ketrenosa613bff2005-08-24 21:43:11 -050010594{
10595 ipw_led_link_down(priv);
10596 netif_carrier_off(priv->net_dev);
10597 netif_stop_queue(priv->net_dev);
10598 notify_wx_assoc_event(priv);
10599
10600 /* Cancel any queued work ... */
10601 cancel_delayed_work(&priv->request_scan);
10602 cancel_delayed_work(&priv->adhoc_check);
10603 cancel_delayed_work(&priv->gather_stats);
10604
10605 ipw_reset_stats(priv);
10606
James Ketrenosafbf30a2005-08-25 00:05:33 -050010607 if (!(priv->status & STATUS_EXIT_PENDING)) {
10608 /* Queue up another scan... */
10609 queue_work(priv->workqueue, &priv->request_scan);
10610 }
James Ketrenosa613bff2005-08-24 21:43:11 -050010611}
10612
James Ketrenosc848d0a2005-08-24 21:56:24 -050010613static void ipw_bg_link_down(void *data)
10614{
10615 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080010616 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010617 ipw_link_down(data);
Zhu Yi46441512006-01-24 16:37:59 +080010618 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010619}
10620
James Ketrenos43f66a62005-03-25 12:31:53 -060010621static int ipw_setup_deferred_work(struct ipw_priv *priv)
10622{
10623 int ret = 0;
10624
James Ketrenos43f66a62005-03-25 12:31:53 -060010625 priv->workqueue = create_workqueue(DRV_NAME);
James Ketrenos43f66a62005-03-25 12:31:53 -060010626 init_waitqueue_head(&priv->wait_command_queue);
James Ketrenosafbf30a2005-08-25 00:05:33 -050010627 init_waitqueue_head(&priv->wait_state);
James Ketrenos43f66a62005-03-25 12:31:53 -060010628
James Ketrenosc848d0a2005-08-24 21:56:24 -050010629 INIT_WORK(&priv->adhoc_check, ipw_bg_adhoc_check, priv);
10630 INIT_WORK(&priv->associate, ipw_bg_associate, priv);
10631 INIT_WORK(&priv->disassociate, ipw_bg_disassociate, priv);
Zhu Yid8bad6d2005-07-13 12:25:38 -050010632 INIT_WORK(&priv->system_config, ipw_system_config, priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010633 INIT_WORK(&priv->rx_replenish, ipw_bg_rx_queue_replenish, priv);
10634 INIT_WORK(&priv->adapter_restart, ipw_bg_adapter_restart, priv);
10635 INIT_WORK(&priv->rf_kill, ipw_bg_rf_kill, priv);
10636 INIT_WORK(&priv->up, (void (*)(void *))ipw_bg_up, priv);
10637 INIT_WORK(&priv->down, (void (*)(void *))ipw_bg_down, priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010638 INIT_WORK(&priv->request_scan,
James Ketrenos43f66a62005-03-25 12:31:53 -060010639 (void (*)(void *))ipw_request_scan, priv);
Zhu Yi094c4d22006-08-21 11:39:03 +080010640 INIT_WORK(&priv->request_passive_scan,
10641 (void (*)(void *))ipw_request_passive_scan, priv);
Jeff Garzikbf794512005-07-31 13:07:26 -040010642 INIT_WORK(&priv->gather_stats,
James Ketrenosc848d0a2005-08-24 21:56:24 -050010643 (void (*)(void *))ipw_bg_gather_stats, priv);
10644 INIT_WORK(&priv->abort_scan, (void (*)(void *))ipw_bg_abort_scan, priv);
10645 INIT_WORK(&priv->roam, ipw_bg_roam, priv);
10646 INIT_WORK(&priv->scan_check, ipw_bg_scan_check, priv);
10647 INIT_WORK(&priv->link_up, (void (*)(void *))ipw_bg_link_up, priv);
10648 INIT_WORK(&priv->link_down, (void (*)(void *))ipw_bg_link_down, priv);
10649 INIT_WORK(&priv->led_link_on, (void (*)(void *))ipw_bg_led_link_on,
James Ketrenosa613bff2005-08-24 21:43:11 -050010650 priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010651 INIT_WORK(&priv->led_link_off, (void (*)(void *))ipw_bg_led_link_off,
James Ketrenosa613bff2005-08-24 21:43:11 -050010652 priv);
James Ketrenosc848d0a2005-08-24 21:56:24 -050010653 INIT_WORK(&priv->led_act_off, (void (*)(void *))ipw_bg_led_activity_off,
10654 priv);
10655 INIT_WORK(&priv->merge_networks,
10656 (void (*)(void *))ipw_merge_adhoc_network, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010657
Zhu Yie43e3c12006-04-13 17:20:45 +080010658#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010659 INIT_WORK(&priv->qos_activate, (void (*)(void *))ipw_bg_qos_activate,
10660 priv);
Zhu Yie43e3c12006-04-13 17:20:45 +080010661#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010662
10663 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
10664 ipw_irq_tasklet, (unsigned long)priv);
10665
10666 return ret;
10667}
10668
James Ketrenos43f66a62005-03-25 12:31:53 -060010669static void shim__set_security(struct net_device *dev,
10670 struct ieee80211_security *sec)
10671{
10672 struct ipw_priv *priv = ieee80211_priv(dev);
10673 int i;
Jeff Garzikbf794512005-07-31 13:07:26 -040010674 for (i = 0; i < 4; i++) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010675 if (sec->flags & (1 << i)) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050010676 priv->ieee->sec.encode_alg[i] = sec->encode_alg[i];
James Ketrenosb095c382005-08-24 22:04:42 -050010677 priv->ieee->sec.key_sizes[i] = sec->key_sizes[i];
James Ketrenos43f66a62005-03-25 12:31:53 -060010678 if (sec->key_sizes[i] == 0)
James Ketrenosb095c382005-08-24 22:04:42 -050010679 priv->ieee->sec.flags &= ~(1 << i);
10680 else {
10681 memcpy(priv->ieee->sec.keys[i], sec->keys[i],
James Ketrenos43f66a62005-03-25 12:31:53 -060010682 sec->key_sizes[i]);
James Ketrenosb095c382005-08-24 22:04:42 -050010683 priv->ieee->sec.flags |= (1 << i);
10684 }
James Ketrenos43f66a62005-03-25 12:31:53 -060010685 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010686 } else if (sec->level != SEC_LEVEL_1)
10687 priv->ieee->sec.flags &= ~(1 << i);
James Ketrenos43f66a62005-03-25 12:31:53 -060010688 }
10689
James Ketrenosb095c382005-08-24 22:04:42 -050010690 if (sec->flags & SEC_ACTIVE_KEY) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010691 if (sec->active_key <= 3) {
James Ketrenosb095c382005-08-24 22:04:42 -050010692 priv->ieee->sec.active_key = sec->active_key;
10693 priv->ieee->sec.flags |= SEC_ACTIVE_KEY;
Jeff Garzikbf794512005-07-31 13:07:26 -040010694 } else
James Ketrenosb095c382005-08-24 22:04:42 -050010695 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010696 priv->status |= STATUS_SECURITY_UPDATED;
James Ketrenosb095c382005-08-24 22:04:42 -050010697 } else
10698 priv->ieee->sec.flags &= ~SEC_ACTIVE_KEY;
James Ketrenos43f66a62005-03-25 12:31:53 -060010699
10700 if ((sec->flags & SEC_AUTH_MODE) &&
James Ketrenosb095c382005-08-24 22:04:42 -050010701 (priv->ieee->sec.auth_mode != sec->auth_mode)) {
10702 priv->ieee->sec.auth_mode = sec->auth_mode;
10703 priv->ieee->sec.flags |= SEC_AUTH_MODE;
James Ketrenos43f66a62005-03-25 12:31:53 -060010704 if (sec->auth_mode == WLAN_AUTH_SHARED_KEY)
10705 priv->capability |= CAP_SHARED_KEY;
10706 else
10707 priv->capability &= ~CAP_SHARED_KEY;
10708 priv->status |= STATUS_SECURITY_UPDATED;
10709 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010710
James Ketrenosb095c382005-08-24 22:04:42 -050010711 if (sec->flags & SEC_ENABLED && priv->ieee->sec.enabled != sec->enabled) {
10712 priv->ieee->sec.flags |= SEC_ENABLED;
10713 priv->ieee->sec.enabled = sec->enabled;
James Ketrenos43f66a62005-03-25 12:31:53 -060010714 priv->status |= STATUS_SECURITY_UPDATED;
Jeff Garzikbf794512005-07-31 13:07:26 -040010715 if (sec->enabled)
James Ketrenos43f66a62005-03-25 12:31:53 -060010716 priv->capability |= CAP_PRIVACY_ON;
10717 else
10718 priv->capability &= ~CAP_PRIVACY_ON;
10719 }
Jeff Garzikbf794512005-07-31 13:07:26 -040010720
James Ketrenosafbf30a2005-08-25 00:05:33 -050010721 if (sec->flags & SEC_ENCRYPT)
10722 priv->ieee->sec.encrypt = sec->encrypt;
James Ketrenos43f66a62005-03-25 12:31:53 -060010723
James Ketrenosb095c382005-08-24 22:04:42 -050010724 if (sec->flags & SEC_LEVEL && priv->ieee->sec.level != sec->level) {
10725 priv->ieee->sec.level = sec->level;
10726 priv->ieee->sec.flags |= SEC_LEVEL;
James Ketrenos43f66a62005-03-25 12:31:53 -060010727 priv->status |= STATUS_SECURITY_UPDATED;
10728 }
10729
Zhu Yi1fbfea52005-08-05 17:22:56 +080010730 if (!priv->ieee->host_encrypt && (sec->flags & SEC_ENCRYPT))
10731 ipw_set_hwcrypto_keys(priv);
10732
Jeff Garzikbf794512005-07-31 13:07:26 -040010733 /* To match current functionality of ipw2100 (which works well w/
10734 * various supplicants, we don't force a disassociate if the
James Ketrenos43f66a62005-03-25 12:31:53 -060010735 * privacy capability changes ... */
10736#if 0
10737 if ((priv->status & (STATUS_ASSOCIATED | STATUS_ASSOCIATING)) &&
Jeff Garzikbf794512005-07-31 13:07:26 -040010738 (((priv->assoc_request.capability &
James Ketrenos43f66a62005-03-25 12:31:53 -060010739 WLAN_CAPABILITY_PRIVACY) && !sec->enabled) ||
Jeff Garzikbf794512005-07-31 13:07:26 -040010740 (!(priv->assoc_request.capability &
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010741 WLAN_CAPABILITY_PRIVACY) && sec->enabled))) {
James Ketrenos43f66a62005-03-25 12:31:53 -060010742 IPW_DEBUG_ASSOC("Disassociating due to capability "
10743 "change.\n");
10744 ipw_disassociate(priv);
10745 }
10746#endif
10747}
10748
Jeff Garzikbf794512005-07-31 13:07:26 -040010749static int init_supported_rates(struct ipw_priv *priv,
James Ketrenos43f66a62005-03-25 12:31:53 -060010750 struct ipw_supported_rates *rates)
10751{
10752 /* TODO: Mask out rates based on priv->rates_mask */
10753
10754 memset(rates, 0, sizeof(*rates));
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010755 /* configure supported rates */
James Ketrenos43f66a62005-03-25 12:31:53 -060010756 switch (priv->ieee->freq_band) {
10757 case IEEE80211_52GHZ_BAND:
10758 rates->ieee_mode = IPW_A_MODE;
10759 rates->purpose = IPW_RATE_CAPABILITIES;
10760 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10761 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10762 break;
10763
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010764 default: /* Mixed or 2.4Ghz */
James Ketrenos43f66a62005-03-25 12:31:53 -060010765 rates->ieee_mode = IPW_G_MODE;
10766 rates->purpose = IPW_RATE_CAPABILITIES;
10767 ipw_add_cck_scan_rates(rates, IEEE80211_CCK_MODULATION,
10768 IEEE80211_CCK_DEFAULT_RATES_MASK);
10769 if (priv->ieee->modulation & IEEE80211_OFDM_MODULATION) {
10770 ipw_add_ofdm_scan_rates(rates, IEEE80211_CCK_MODULATION,
10771 IEEE80211_OFDM_DEFAULT_RATES_MASK);
10772 }
10773 break;
10774 }
10775
10776 return 0;
10777}
10778
Jeff Garzikbf794512005-07-31 13:07:26 -040010779static int ipw_config(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060010780{
James Ketrenos43f66a62005-03-25 12:31:53 -060010781 /* This is only called from ipw_up, which resets/reloads the firmware
10782 so, we don't need to first disable the card before we configure
10783 it */
Zhu Yi6de9f7f2005-08-11 14:39:33 +080010784 if (ipw_set_tx_power(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010785 goto error;
10786
10787 /* initialize adapter address */
10788 if (ipw_send_adapter_address(priv, priv->net_dev->dev_addr))
10789 goto error;
10790
10791 /* set basic system config settings */
10792 init_sys_config(&priv->sys_config);
Zhu Yi810dabd2006-01-24 16:36:59 +080010793
10794 /* Support Bluetooth if we have BT h/w on board, and user wants to.
10795 * Does not support BT priority yet (don't abort or defer our Tx) */
10796 if (bt_coexist) {
Zhu Yi2638bc32006-01-24 16:37:52 +080010797 unsigned char bt_caps = priv->eeprom[EEPROM_SKU_CAPABILITY];
Zhu Yi810dabd2006-01-24 16:36:59 +080010798
10799 if (bt_caps & EEPROM_SKU_CAP_BT_CHANNEL_SIG)
10800 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010801 |= CFG_BT_COEXISTENCE_SIGNAL_CHNL;
Zhu Yi810dabd2006-01-24 16:36:59 +080010802 if (bt_caps & EEPROM_SKU_CAP_BT_OOB)
10803 priv->sys_config.bt_coexistence
Zhu Yi2638bc32006-01-24 16:37:52 +080010804 |= CFG_BT_COEXISTENCE_OOB;
Zhu Yi810dabd2006-01-24 16:36:59 +080010805 }
10806
Zhu Yid685b8c2006-04-13 17:20:27 +080010807#ifdef CONFIG_IPW2200_PROMISCUOUS
10808 if (priv->prom_net_dev && netif_running(priv->prom_net_dev)) {
10809 priv->sys_config.accept_all_data_frames = 1;
10810 priv->sys_config.accept_non_directed_frames = 1;
10811 priv->sys_config.accept_all_mgmt_bcpr = 1;
10812 priv->sys_config.accept_all_mgmt_frames = 1;
10813 }
10814#endif
10815
James Ketrenosc848d0a2005-08-24 21:56:24 -050010816 if (priv->ieee->iw_mode == IW_MODE_ADHOC)
10817 priv->sys_config.answer_broadcast_ssid_probe = 1;
10818 else
10819 priv->sys_config.answer_broadcast_ssid_probe = 0;
10820
Zhu Yid685b8c2006-04-13 17:20:27 +080010821 if (ipw_send_system_config(priv))
James Ketrenos43f66a62005-03-25 12:31:53 -060010822 goto error;
10823
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010824 init_supported_rates(priv, &priv->rates);
10825 if (ipw_send_supported_rates(priv, &priv->rates))
James Ketrenos43f66a62005-03-25 12:31:53 -060010826 goto error;
10827
10828 /* Set request-to-send threshold */
10829 if (priv->rts_threshold) {
10830 if (ipw_send_rts_threshold(priv, priv->rts_threshold))
10831 goto error;
10832 }
Zhu Yie43e3c12006-04-13 17:20:45 +080010833#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050010834 IPW_DEBUG_QOS("QoS: call ipw_qos_activate\n");
10835 ipw_qos_activate(priv, NULL);
Zhu Yie43e3c12006-04-13 17:20:45 +080010836#endif /* CONFIG_IPW2200_QOS */
James Ketrenos43f66a62005-03-25 12:31:53 -060010837
10838 if (ipw_set_random_seed(priv))
10839 goto error;
Jeff Garzikbf794512005-07-31 13:07:26 -040010840
James Ketrenos43f66a62005-03-25 12:31:53 -060010841 /* final state transition to the RUN state */
10842 if (ipw_send_host_complete(priv))
10843 goto error;
10844
James Ketrenose6666192005-08-12 09:17:04 -050010845 priv->status |= STATUS_INIT;
10846
10847 ipw_led_init(priv);
10848 ipw_led_radio_on(priv);
10849 priv->notif_missed_beacons = 0;
10850
10851 /* Set hardware WEP key if it is configured. */
10852 if ((priv->capability & CAP_PRIVACY_ON) &&
10853 (priv->ieee->sec.level == SEC_LEVEL_1) &&
10854 !(priv->ieee->host_encrypt || priv->ieee->host_decrypt))
10855 ipw_set_hwcrypto_keys(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060010856
10857 return 0;
Jeff Garzikbf794512005-07-31 13:07:26 -040010858
Jeff Garzik0edd5b42005-09-07 00:48:31 -040010859 error:
James Ketrenos43f66a62005-03-25 12:31:53 -060010860 return -EIO;
10861}
10862
James Ketrenos4f36f802005-08-03 20:36:56 -050010863/*
10864 * NOTE:
10865 *
10866 * These tables have been tested in conjunction with the
10867 * Intel PRO/Wireless 2200BG and 2915ABG Network Connection Adapters.
10868 *
10869 * Altering this values, using it on other hardware, or in geographies
10870 * not intended for resale of the above mentioned Intel adapters has
10871 * not been tested.
10872 *
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080010873 * Remember to update the table in README.ipw2200 when changing this
10874 * table.
10875 *
James Ketrenos4f36f802005-08-03 20:36:56 -050010876 */
10877static const struct ieee80211_geo ipw_geos[] = {
10878 { /* Restricted */
10879 "---",
10880 .bg_channels = 11,
10881 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10882 {2427, 4}, {2432, 5}, {2437, 6},
10883 {2442, 7}, {2447, 8}, {2452, 9},
10884 {2457, 10}, {2462, 11}},
10885 },
10886
10887 { /* Custom US/Canada */
10888 "ZZF",
10889 .bg_channels = 11,
10890 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10891 {2427, 4}, {2432, 5}, {2437, 6},
10892 {2442, 7}, {2447, 8}, {2452, 9},
10893 {2457, 10}, {2462, 11}},
10894 .a_channels = 8,
10895 .a = {{5180, 36},
10896 {5200, 40},
10897 {5220, 44},
10898 {5240, 48},
10899 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10900 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10901 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10902 {5320, 64, IEEE80211_CH_PASSIVE_ONLY}},
10903 },
10904
10905 { /* Rest of World */
10906 "ZZD",
10907 .bg_channels = 13,
10908 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10909 {2427, 4}, {2432, 5}, {2437, 6},
10910 {2442, 7}, {2447, 8}, {2452, 9},
10911 {2457, 10}, {2462, 11}, {2467, 12},
10912 {2472, 13}},
10913 },
10914
10915 { /* Custom USA & Europe & High */
10916 "ZZA",
10917 .bg_channels = 11,
10918 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10919 {2427, 4}, {2432, 5}, {2437, 6},
10920 {2442, 7}, {2447, 8}, {2452, 9},
10921 {2457, 10}, {2462, 11}},
10922 .a_channels = 13,
10923 .a = {{5180, 36},
10924 {5200, 40},
10925 {5220, 44},
10926 {5240, 48},
10927 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10928 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10929 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10930 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10931 {5745, 149},
10932 {5765, 153},
10933 {5785, 157},
10934 {5805, 161},
10935 {5825, 165}},
10936 },
10937
10938 { /* Custom NA & Europe */
10939 "ZZB",
10940 .bg_channels = 11,
10941 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10942 {2427, 4}, {2432, 5}, {2437, 6},
10943 {2442, 7}, {2447, 8}, {2452, 9},
10944 {2457, 10}, {2462, 11}},
10945 .a_channels = 13,
10946 .a = {{5180, 36},
10947 {5200, 40},
10948 {5220, 44},
10949 {5240, 48},
10950 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10951 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10952 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10953 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10954 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
10955 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
10956 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
10957 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
10958 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
10959 },
10960
10961 { /* Custom Japan */
10962 "ZZC",
10963 .bg_channels = 11,
10964 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10965 {2427, 4}, {2432, 5}, {2437, 6},
10966 {2442, 7}, {2447, 8}, {2452, 9},
10967 {2457, 10}, {2462, 11}},
10968 .a_channels = 4,
10969 .a = {{5170, 34}, {5190, 38},
10970 {5210, 42}, {5230, 46}},
10971 },
10972
10973 { /* Custom */
10974 "ZZM",
10975 .bg_channels = 11,
10976 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10977 {2427, 4}, {2432, 5}, {2437, 6},
10978 {2442, 7}, {2447, 8}, {2452, 9},
10979 {2457, 10}, {2462, 11}},
10980 },
10981
10982 { /* Europe */
10983 "ZZE",
10984 .bg_channels = 13,
10985 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
10986 {2427, 4}, {2432, 5}, {2437, 6},
10987 {2442, 7}, {2447, 8}, {2452, 9},
10988 {2457, 10}, {2462, 11}, {2467, 12},
10989 {2472, 13}},
10990 .a_channels = 19,
10991 .a = {{5180, 36},
10992 {5200, 40},
10993 {5220, 44},
10994 {5240, 48},
10995 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
10996 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
10997 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
10998 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
10999 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11000 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11001 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11002 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11003 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11004 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11005 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11006 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11007 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11008 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11009 {5700, 140, IEEE80211_CH_PASSIVE_ONLY}},
11010 },
11011
11012 { /* Custom Japan */
11013 "ZZJ",
11014 .bg_channels = 14,
11015 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11016 {2427, 4}, {2432, 5}, {2437, 6},
11017 {2442, 7}, {2447, 8}, {2452, 9},
11018 {2457, 10}, {2462, 11}, {2467, 12},
11019 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY}},
11020 .a_channels = 4,
11021 .a = {{5170, 34}, {5190, 38},
11022 {5210, 42}, {5230, 46}},
11023 },
11024
James Ketrenos03520572005-10-19 16:12:31 -050011025 { /* Rest of World */
11026 "ZZR",
11027 .bg_channels = 14,
11028 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11029 {2427, 4}, {2432, 5}, {2437, 6},
11030 {2442, 7}, {2447, 8}, {2452, 9},
11031 {2457, 10}, {2462, 11}, {2467, 12},
11032 {2472, 13}, {2484, 14, IEEE80211_CH_B_ONLY |
11033 IEEE80211_CH_PASSIVE_ONLY}},
11034 },
11035
James Ketrenos4f36f802005-08-03 20:36:56 -050011036 { /* High Band */
11037 "ZZH",
11038 .bg_channels = 13,
11039 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11040 {2427, 4}, {2432, 5}, {2437, 6},
11041 {2442, 7}, {2447, 8}, {2452, 9},
11042 {2457, 10}, {2462, 11},
11043 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11044 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11045 .a_channels = 4,
11046 .a = {{5745, 149}, {5765, 153},
11047 {5785, 157}, {5805, 161}},
11048 },
11049
11050 { /* Custom Europe */
11051 "ZZG",
11052 .bg_channels = 13,
11053 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11054 {2427, 4}, {2432, 5}, {2437, 6},
11055 {2442, 7}, {2447, 8}, {2452, 9},
11056 {2457, 10}, {2462, 11},
11057 {2467, 12}, {2472, 13}},
11058 .a_channels = 4,
11059 .a = {{5180, 36}, {5200, 40},
11060 {5220, 44}, {5240, 48}},
11061 },
11062
11063 { /* Europe */
11064 "ZZK",
11065 .bg_channels = 13,
11066 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11067 {2427, 4}, {2432, 5}, {2437, 6},
11068 {2442, 7}, {2447, 8}, {2452, 9},
11069 {2457, 10}, {2462, 11},
11070 {2467, 12, IEEE80211_CH_PASSIVE_ONLY},
11071 {2472, 13, IEEE80211_CH_PASSIVE_ONLY}},
11072 .a_channels = 24,
11073 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11074 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11075 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11076 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11077 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11078 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11079 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11080 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11081 {5500, 100, IEEE80211_CH_PASSIVE_ONLY},
11082 {5520, 104, IEEE80211_CH_PASSIVE_ONLY},
11083 {5540, 108, IEEE80211_CH_PASSIVE_ONLY},
11084 {5560, 112, IEEE80211_CH_PASSIVE_ONLY},
11085 {5580, 116, IEEE80211_CH_PASSIVE_ONLY},
11086 {5600, 120, IEEE80211_CH_PASSIVE_ONLY},
11087 {5620, 124, IEEE80211_CH_PASSIVE_ONLY},
11088 {5640, 128, IEEE80211_CH_PASSIVE_ONLY},
11089 {5660, 132, IEEE80211_CH_PASSIVE_ONLY},
11090 {5680, 136, IEEE80211_CH_PASSIVE_ONLY},
11091 {5700, 140, IEEE80211_CH_PASSIVE_ONLY},
11092 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11093 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11094 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11095 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11096 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11097 },
11098
11099 { /* Europe */
11100 "ZZL",
11101 .bg_channels = 11,
11102 .bg = {{2412, 1}, {2417, 2}, {2422, 3},
11103 {2427, 4}, {2432, 5}, {2437, 6},
11104 {2442, 7}, {2447, 8}, {2452, 9},
11105 {2457, 10}, {2462, 11}},
11106 .a_channels = 13,
11107 .a = {{5180, 36, IEEE80211_CH_PASSIVE_ONLY},
11108 {5200, 40, IEEE80211_CH_PASSIVE_ONLY},
11109 {5220, 44, IEEE80211_CH_PASSIVE_ONLY},
11110 {5240, 48, IEEE80211_CH_PASSIVE_ONLY},
11111 {5260, 52, IEEE80211_CH_PASSIVE_ONLY},
11112 {5280, 56, IEEE80211_CH_PASSIVE_ONLY},
11113 {5300, 60, IEEE80211_CH_PASSIVE_ONLY},
11114 {5320, 64, IEEE80211_CH_PASSIVE_ONLY},
11115 {5745, 149, IEEE80211_CH_PASSIVE_ONLY},
11116 {5765, 153, IEEE80211_CH_PASSIVE_ONLY},
11117 {5785, 157, IEEE80211_CH_PASSIVE_ONLY},
11118 {5805, 161, IEEE80211_CH_PASSIVE_ONLY},
11119 {5825, 165, IEEE80211_CH_PASSIVE_ONLY}},
11120 }
James Ketrenosafbf30a2005-08-25 00:05:33 -050011121};
11122
James Ketrenos43f66a62005-03-25 12:31:53 -060011123#define MAX_HW_RESTARTS 5
11124static int ipw_up(struct ipw_priv *priv)
11125{
James Ketrenos4f36f802005-08-03 20:36:56 -050011126 int rc, i, j;
James Ketrenos43f66a62005-03-25 12:31:53 -060011127
11128 if (priv->status & STATUS_EXIT_PENDING)
11129 return -EIO;
11130
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011131 if (cmdlog && !priv->cmdlog) {
Yan Burmane6e3f122006-12-02 13:38:14 +020011132 priv->cmdlog = kcalloc(cmdlog, sizeof(*priv->cmdlog),
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011133 GFP_KERNEL);
11134 if (priv->cmdlog == NULL) {
11135 IPW_ERROR("Error allocating %d command log entries.\n",
11136 cmdlog);
Zhu Yid0b526b2006-04-13 17:19:50 +080011137 return -ENOMEM;
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011138 } else {
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011139 priv->cmdlog_len = cmdlog;
11140 }
11141 }
11142
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011143 for (i = 0; i < MAX_HW_RESTARTS; i++) {
Jeff Garzikbf794512005-07-31 13:07:26 -040011144 /* Load the microcode, firmware, and eeprom.
James Ketrenos43f66a62005-03-25 12:31:53 -060011145 * Also start the clocks. */
11146 rc = ipw_load(priv);
11147 if (rc) {
Peter Jonesa4f6bbb2005-08-26 00:33:34 -050011148 IPW_ERROR("Unable to load firmware: %d\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011149 return rc;
11150 }
11151
11152 ipw_init_ordinals(priv);
11153 if (!(priv->config & CFG_CUSTOM_MAC))
11154 eeprom_parse_mac(priv, priv->mac_addr);
11155 memcpy(priv->net_dev->dev_addr, priv->mac_addr, ETH_ALEN);
11156
James Ketrenos4f36f802005-08-03 20:36:56 -050011157 for (j = 0; j < ARRAY_SIZE(ipw_geos); j++) {
11158 if (!memcmp(&priv->eeprom[EEPROM_COUNTRY_CODE],
11159 ipw_geos[j].name, 3))
11160 break;
11161 }
James Ketrenos03520572005-10-19 16:12:31 -050011162 if (j == ARRAY_SIZE(ipw_geos)) {
11163 IPW_WARNING("SKU [%c%c%c] not recognized.\n",
11164 priv->eeprom[EEPROM_COUNTRY_CODE + 0],
11165 priv->eeprom[EEPROM_COUNTRY_CODE + 1],
11166 priv->eeprom[EEPROM_COUNTRY_CODE + 2]);
James Ketrenos4f36f802005-08-03 20:36:56 -050011167 j = 0;
James Ketrenos03520572005-10-19 16:12:31 -050011168 }
Larry Finger1867b112006-02-28 09:48:28 -060011169 if (ieee80211_set_geo(priv->ieee, &ipw_geos[j])) {
James Ketrenos4f36f802005-08-03 20:36:56 -050011170 IPW_WARNING("Could not set geography.");
James Ketrenos43f66a62005-03-25 12:31:53 -060011171 return 0;
James Ketrenos4f36f802005-08-03 20:36:56 -050011172 }
11173
James Ketrenosb095c382005-08-24 22:04:42 -050011174 if (priv->status & STATUS_RF_KILL_SW) {
11175 IPW_WARNING("Radio disabled by module parameter.\n");
11176 return 0;
11177 } else if (rf_kill_active(priv)) {
11178 IPW_WARNING("Radio Frequency Kill Switch is On:\n"
11179 "Kill switch must be turned off for "
11180 "wireless networking to work.\n");
11181 queue_delayed_work(priv->workqueue, &priv->rf_kill,
11182 2 * HZ);
James Ketrenos43f66a62005-03-25 12:31:53 -060011183 return 0;
James Ketrenosc848d0a2005-08-24 21:56:24 -050011184 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011185
11186 rc = ipw_config(priv);
11187 if (!rc) {
11188 IPW_DEBUG_INFO("Configured device on count %i\n", i);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011189
James Ketrenose6666192005-08-12 09:17:04 -050011190 /* If configure to try and auto-associate, kick
11191 * off a scan. */
11192 queue_work(priv->workqueue, &priv->request_scan);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011193
James Ketrenos43f66a62005-03-25 12:31:53 -060011194 return 0;
James Ketrenos43f66a62005-03-25 12:31:53 -060011195 }
Jeff Garzikbf794512005-07-31 13:07:26 -040011196
James Ketrenosc848d0a2005-08-24 21:56:24 -050011197 IPW_DEBUG_INFO("Device configuration failed: 0x%08X\n", rc);
James Ketrenos43f66a62005-03-25 12:31:53 -060011198 IPW_DEBUG_INFO("Failed to config device on retry %d of %d\n",
11199 i, MAX_HW_RESTARTS);
11200
11201 /* We had an error bringing up the hardware, so take it
11202 * all the way back down so we can try again */
11203 ipw_down(priv);
11204 }
11205
Jeff Garzikbf794512005-07-31 13:07:26 -040011206 /* tried to restart and config the device for as long as our
James Ketrenos43f66a62005-03-25 12:31:53 -060011207 * patience could withstand */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011208 IPW_ERROR("Unable to initialize device after %d attempts.\n", i);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011209
James Ketrenos43f66a62005-03-25 12:31:53 -060011210 return -EIO;
11211}
11212
James Ketrenosc848d0a2005-08-24 21:56:24 -050011213static void ipw_bg_up(void *data)
11214{
11215 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080011216 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011217 ipw_up(data);
Zhu Yi46441512006-01-24 16:37:59 +080011218 mutex_unlock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011219}
11220
James Ketrenosb095c382005-08-24 22:04:42 -050011221static void ipw_deinit(struct ipw_priv *priv)
James Ketrenos43f66a62005-03-25 12:31:53 -060011222{
James Ketrenosb095c382005-08-24 22:04:42 -050011223 int i;
11224
11225 if (priv->status & STATUS_SCANNING) {
11226 IPW_DEBUG_INFO("Aborting scan during shutdown.\n");
11227 ipw_abort_scan(priv);
11228 }
11229
11230 if (priv->status & STATUS_ASSOCIATED) {
11231 IPW_DEBUG_INFO("Disassociating during shutdown.\n");
11232 ipw_disassociate(priv);
11233 }
11234
11235 ipw_led_shutdown(priv);
11236
11237 /* Wait up to 1s for status to change to not scanning and not
11238 * associated (disassociation can take a while for a ful 802.11
11239 * exchange */
11240 for (i = 1000; i && (priv->status &
11241 (STATUS_DISASSOCIATING |
11242 STATUS_ASSOCIATED | STATUS_SCANNING)); i--)
11243 udelay(10);
11244
11245 if (priv->status & (STATUS_DISASSOCIATING |
11246 STATUS_ASSOCIATED | STATUS_SCANNING))
11247 IPW_DEBUG_INFO("Still associated or scanning...\n");
11248 else
11249 IPW_DEBUG_INFO("Took %dms to de-init\n", 1000 - i);
11250
James Ketrenosc848d0a2005-08-24 21:56:24 -050011251 /* Attempt to disable the card */
James Ketrenos43f66a62005-03-25 12:31:53 -060011252 ipw_send_card_disable(priv, 0);
James Ketrenosb095c382005-08-24 22:04:42 -050011253
11254 priv->status &= ~STATUS_INIT;
11255}
11256
James Ketrenos43f66a62005-03-25 12:31:53 -060011257static void ipw_down(struct ipw_priv *priv)
11258{
James Ketrenosb095c382005-08-24 22:04:42 -050011259 int exit_pending = priv->status & STATUS_EXIT_PENDING;
11260
11261 priv->status |= STATUS_EXIT_PENDING;
11262
11263 if (ipw_is_init(priv))
11264 ipw_deinit(priv);
11265
11266 /* Wipe out the EXIT_PENDING status bit if we are not actually
11267 * exiting the module */
11268 if (!exit_pending)
11269 priv->status &= ~STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011270
11271 /* tell the device to stop sending interrupts */
11272 ipw_disable_interrupts(priv);
11273
11274 /* Clear all bits but the RF Kill */
James Ketrenosb095c382005-08-24 22:04:42 -050011275 priv->status &= STATUS_RF_KILL_MASK | STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011276 netif_carrier_off(priv->net_dev);
11277 netif_stop_queue(priv->net_dev);
11278
11279 ipw_stop_nic(priv);
James Ketrenosa613bff2005-08-24 21:43:11 -050011280
11281 ipw_led_radio_off(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011282}
11283
James Ketrenosc848d0a2005-08-24 21:56:24 -050011284static void ipw_bg_down(void *data)
11285{
11286 struct ipw_priv *priv = data;
Zhu Yi46441512006-01-24 16:37:59 +080011287 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011288 ipw_down(data);
Zhu Yi46441512006-01-24 16:37:59 +080011289 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011290}
11291
11292/* Called by register_netdev() */
11293static int ipw_net_init(struct net_device *dev)
11294{
11295 struct ipw_priv *priv = ieee80211_priv(dev);
Zhu Yi46441512006-01-24 16:37:59 +080011296 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011297
James Ketrenosc848d0a2005-08-24 21:56:24 -050011298 if (ipw_up(priv)) {
Zhu Yi46441512006-01-24 16:37:59 +080011299 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011300 return -EIO;
James Ketrenos43f66a62005-03-25 12:31:53 -060011301 }
11302
Zhu Yi46441512006-01-24 16:37:59 +080011303 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011304 return 0;
11305}
11306
11307/* PCI driver stuff */
11308static struct pci_device_id card_ids[] = {
11309 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2701, 0, 0, 0},
11310 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2702, 0, 0, 0},
11311 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2711, 0, 0, 0},
11312 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2712, 0, 0, 0},
11313 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2721, 0, 0, 0},
11314 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2722, 0, 0, 0},
11315 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2731, 0, 0, 0},
11316 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2732, 0, 0, 0},
11317 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2741, 0, 0, 0},
11318 {PCI_VENDOR_ID_INTEL, 0x1043, 0x103c, 0x2741, 0, 0, 0},
11319 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2742, 0, 0, 0},
11320 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2751, 0, 0, 0},
11321 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2752, 0, 0, 0},
11322 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2753, 0, 0, 0},
11323 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2754, 0, 0, 0},
11324 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2761, 0, 0, 0},
11325 {PCI_VENDOR_ID_INTEL, 0x1043, 0x8086, 0x2762, 0, 0, 0},
11326 {PCI_VENDOR_ID_INTEL, 0x104f, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011327 {PCI_VENDOR_ID_INTEL, 0x4220, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
James Ketrenosa613bff2005-08-24 21:43:11 -050011328 {PCI_VENDOR_ID_INTEL, 0x4221, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* BG */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011329 {PCI_VENDOR_ID_INTEL, 0x4223, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
11330 {PCI_VENDOR_ID_INTEL, 0x4224, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, /* ABG */
Jeff Garzikbf794512005-07-31 13:07:26 -040011331
James Ketrenos43f66a62005-03-25 12:31:53 -060011332 /* required last entry */
11333 {0,}
11334};
11335
11336MODULE_DEVICE_TABLE(pci, card_ids);
11337
11338static struct attribute *ipw_sysfs_entries[] = {
11339 &dev_attr_rf_kill.attr,
11340 &dev_attr_direct_dword.attr,
11341 &dev_attr_indirect_byte.attr,
11342 &dev_attr_indirect_dword.attr,
11343 &dev_attr_mem_gpio_reg.attr,
11344 &dev_attr_command_event_reg.attr,
11345 &dev_attr_nic_type.attr,
11346 &dev_attr_status.attr,
11347 &dev_attr_cfg.attr,
James Ketrenosb39860c2005-08-12 09:36:32 -050011348 &dev_attr_error.attr,
11349 &dev_attr_event_log.attr,
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011350 &dev_attr_cmd_log.attr,
James Ketrenos43f66a62005-03-25 12:31:53 -060011351 &dev_attr_eeprom_delay.attr,
11352 &dev_attr_ucode_version.attr,
11353 &dev_attr_rtc.attr,
James Ketrenosa613bff2005-08-24 21:43:11 -050011354 &dev_attr_scan_age.attr,
11355 &dev_attr_led.attr,
James Ketrenosb095c382005-08-24 22:04:42 -050011356 &dev_attr_speed_scan.attr,
11357 &dev_attr_net_stats.attr,
Zhu Yid685b8c2006-04-13 17:20:27 +080011358#ifdef CONFIG_IPW2200_PROMISCUOUS
11359 &dev_attr_rtap_iface.attr,
11360 &dev_attr_rtap_filter.attr,
11361#endif
James Ketrenos43f66a62005-03-25 12:31:53 -060011362 NULL
11363};
11364
11365static struct attribute_group ipw_attribute_group = {
11366 .name = NULL, /* put in device directory */
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011367 .attrs = ipw_sysfs_entries,
James Ketrenos43f66a62005-03-25 12:31:53 -060011368};
11369
Zhu Yid685b8c2006-04-13 17:20:27 +080011370#ifdef CONFIG_IPW2200_PROMISCUOUS
11371static int ipw_prom_open(struct net_device *dev)
11372{
11373 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11374 struct ipw_priv *priv = prom_priv->priv;
11375
11376 IPW_DEBUG_INFO("prom dev->open\n");
11377 netif_carrier_off(dev);
11378 netif_stop_queue(dev);
11379
11380 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11381 priv->sys_config.accept_all_data_frames = 1;
11382 priv->sys_config.accept_non_directed_frames = 1;
11383 priv->sys_config.accept_all_mgmt_bcpr = 1;
11384 priv->sys_config.accept_all_mgmt_frames = 1;
11385
11386 ipw_send_system_config(priv);
11387 }
11388
11389 return 0;
11390}
11391
11392static int ipw_prom_stop(struct net_device *dev)
11393{
11394 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11395 struct ipw_priv *priv = prom_priv->priv;
11396
11397 IPW_DEBUG_INFO("prom dev->stop\n");
11398
11399 if (priv->ieee->iw_mode != IW_MODE_MONITOR) {
11400 priv->sys_config.accept_all_data_frames = 0;
11401 priv->sys_config.accept_non_directed_frames = 0;
11402 priv->sys_config.accept_all_mgmt_bcpr = 0;
11403 priv->sys_config.accept_all_mgmt_frames = 0;
11404
11405 ipw_send_system_config(priv);
11406 }
11407
11408 return 0;
11409}
11410
11411static int ipw_prom_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
11412{
11413 IPW_DEBUG_INFO("prom dev->xmit\n");
11414 netif_stop_queue(dev);
11415 return -EOPNOTSUPP;
11416}
11417
11418static struct net_device_stats *ipw_prom_get_stats(struct net_device *dev)
11419{
11420 struct ipw_prom_priv *prom_priv = ieee80211_priv(dev);
11421 return &prom_priv->ieee->stats;
11422}
11423
11424static int ipw_prom_alloc(struct ipw_priv *priv)
11425{
11426 int rc = 0;
11427
11428 if (priv->prom_net_dev)
11429 return -EPERM;
11430
11431 priv->prom_net_dev = alloc_ieee80211(sizeof(struct ipw_prom_priv));
11432 if (priv->prom_net_dev == NULL)
11433 return -ENOMEM;
11434
11435 priv->prom_priv = ieee80211_priv(priv->prom_net_dev);
11436 priv->prom_priv->ieee = netdev_priv(priv->prom_net_dev);
11437 priv->prom_priv->priv = priv;
11438
11439 strcpy(priv->prom_net_dev->name, "rtap%d");
11440
11441 priv->prom_net_dev->type = ARPHRD_IEEE80211_RADIOTAP;
11442 priv->prom_net_dev->open = ipw_prom_open;
11443 priv->prom_net_dev->stop = ipw_prom_stop;
11444 priv->prom_net_dev->get_stats = ipw_prom_get_stats;
11445 priv->prom_net_dev->hard_start_xmit = ipw_prom_hard_start_xmit;
11446
11447 priv->prom_priv->ieee->iw_mode = IW_MODE_MONITOR;
11448
11449 rc = register_netdev(priv->prom_net_dev);
11450 if (rc) {
11451 free_ieee80211(priv->prom_net_dev);
11452 priv->prom_net_dev = NULL;
11453 return rc;
11454 }
11455
11456 return 0;
11457}
11458
11459static void ipw_prom_free(struct ipw_priv *priv)
11460{
11461 if (!priv->prom_net_dev)
11462 return;
11463
11464 unregister_netdev(priv->prom_net_dev);
11465 free_ieee80211(priv->prom_net_dev);
11466
11467 priv->prom_net_dev = NULL;
11468}
11469
11470#endif
11471
11472
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011473static int ipw_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
James Ketrenos43f66a62005-03-25 12:31:53 -060011474{
11475 int err = 0;
11476 struct net_device *net_dev;
11477 void __iomem *base;
11478 u32 length, val;
11479 struct ipw_priv *priv;
James Ketrenosafbf30a2005-08-25 00:05:33 -050011480 int i;
James Ketrenos43f66a62005-03-25 12:31:53 -060011481
11482 net_dev = alloc_ieee80211(sizeof(struct ipw_priv));
11483 if (net_dev == NULL) {
11484 err = -ENOMEM;
11485 goto out;
11486 }
11487
11488 priv = ieee80211_priv(net_dev);
11489 priv->ieee = netdev_priv(net_dev);
James Ketrenosa613bff2005-08-24 21:43:11 -050011490
James Ketrenos43f66a62005-03-25 12:31:53 -060011491 priv->net_dev = net_dev;
11492 priv->pci_dev = pdev;
James Ketrenos43f66a62005-03-25 12:31:53 -060011493 ipw_debug_level = debug;
Zhu Yi89c318e2006-06-08 22:19:49 -070011494 spin_lock_init(&priv->irq_lock);
James Ketrenos43f66a62005-03-25 12:31:53 -060011495 spin_lock_init(&priv->lock);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011496 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++)
11497 INIT_LIST_HEAD(&priv->ibss_mac_hash[i]);
James Ketrenos43f66a62005-03-25 12:31:53 -060011498
Zhu Yi46441512006-01-24 16:37:59 +080011499 mutex_init(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011500 if (pci_enable_device(pdev)) {
11501 err = -ENODEV;
11502 goto out_free_ieee80211;
11503 }
11504
11505 pci_set_master(pdev);
11506
Tobias Klauser0e08b442005-06-20 14:28:41 -070011507 err = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
Jeff Garzikbf794512005-07-31 13:07:26 -040011508 if (!err)
Tobias Klauser0e08b442005-06-20 14:28:41 -070011509 err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK);
James Ketrenos43f66a62005-03-25 12:31:53 -060011510 if (err) {
11511 printk(KERN_WARNING DRV_NAME ": No suitable DMA available.\n");
11512 goto out_pci_disable_device;
11513 }
11514
11515 pci_set_drvdata(pdev, priv);
11516
11517 err = pci_request_regions(pdev, DRV_NAME);
Jeff Garzikbf794512005-07-31 13:07:26 -040011518 if (err)
James Ketrenos43f66a62005-03-25 12:31:53 -060011519 goto out_pci_disable_device;
11520
Jeff Garzikbf794512005-07-31 13:07:26 -040011521 /* We disable the RETRY_TIMEOUT register (0x41) to keep
James Ketrenos43f66a62005-03-25 12:31:53 -060011522 * PCI Tx retries from interfering with C3 CPU state */
Jeff Garzikbf794512005-07-31 13:07:26 -040011523 pci_read_config_dword(pdev, 0x40, &val);
11524 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011525 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
Jeff Garzikbf794512005-07-31 13:07:26 -040011526
James Ketrenos43f66a62005-03-25 12:31:53 -060011527 length = pci_resource_len(pdev, 0);
11528 priv->hw_len = length;
Jeff Garzikbf794512005-07-31 13:07:26 -040011529
James Ketrenos43f66a62005-03-25 12:31:53 -060011530 base = ioremap_nocache(pci_resource_start(pdev, 0), length);
11531 if (!base) {
11532 err = -ENODEV;
11533 goto out_pci_release_regions;
11534 }
11535
11536 priv->hw_base = base;
11537 IPW_DEBUG_INFO("pci_resource_len = 0x%08x\n", length);
11538 IPW_DEBUG_INFO("pci_resource_base = %p\n", base);
11539
11540 err = ipw_setup_deferred_work(priv);
11541 if (err) {
11542 IPW_ERROR("Unable to setup deferred work\n");
11543 goto out_iounmap;
11544 }
11545
James Ketrenosb095c382005-08-24 22:04:42 -050011546 ipw_sw_reset(priv, 1);
James Ketrenos43f66a62005-03-25 12:31:53 -060011547
Thomas Gleixner1fb9df52006-07-01 19:29:39 -070011548 err = request_irq(pdev->irq, ipw_isr, IRQF_SHARED, DRV_NAME, priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011549 if (err) {
11550 IPW_ERROR("Error allocating IRQ %d\n", pdev->irq);
11551 goto out_destroy_workqueue;
11552 }
11553
11554 SET_MODULE_OWNER(net_dev);
11555 SET_NETDEV_DEV(net_dev, &pdev->dev);
11556
Zhu Yi46441512006-01-24 16:37:59 +080011557 mutex_lock(&priv->mutex);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011558
James Ketrenos43f66a62005-03-25 12:31:53 -060011559 priv->ieee->hard_start_xmit = ipw_net_hard_start_xmit;
11560 priv->ieee->set_security = shim__set_security;
James Ketrenos227d2dc2005-07-28 16:25:55 -050011561 priv->ieee->is_queue_full = ipw_net_is_queue_full;
James Ketrenos43f66a62005-03-25 12:31:53 -060011562
Zhu Yie43e3c12006-04-13 17:20:45 +080011563#ifdef CONFIG_IPW2200_QOS
Zhu Yia5cf4fe2006-04-13 17:19:11 +080011564 priv->ieee->is_qos_active = ipw_is_qos_active;
James Ketrenos3b9990c2005-08-19 13:18:55 -050011565 priv->ieee->handle_probe_response = ipw_handle_beacon;
11566 priv->ieee->handle_beacon = ipw_handle_probe_response;
11567 priv->ieee->handle_assoc_response = ipw_handle_assoc_response;
Zhu Yie43e3c12006-04-13 17:20:45 +080011568#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011569
James Ketrenosc848d0a2005-08-24 21:56:24 -050011570 priv->ieee->perfect_rssi = -20;
11571 priv->ieee->worst_rssi = -85;
James Ketrenos43f66a62005-03-25 12:31:53 -060011572
11573 net_dev->open = ipw_net_open;
11574 net_dev->stop = ipw_net_stop;
11575 net_dev->init = ipw_net_init;
11576 net_dev->get_stats = ipw_net_get_stats;
11577 net_dev->set_multicast_list = ipw_net_set_multicast_list;
11578 net_dev->set_mac_address = ipw_net_set_mac_address;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011579 priv->wireless_data.spy_data = &priv->ieee->spy_data;
Benoit Boissinot97a78ca2005-09-15 17:30:28 +000011580 net_dev->wireless_data = &priv->wireless_data;
James Ketrenos43f66a62005-03-25 12:31:53 -060011581 net_dev->wireless_handlers = &ipw_wx_handler_def;
11582 net_dev->ethtool_ops = &ipw_ethtool_ops;
11583 net_dev->irq = pdev->irq;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011584 net_dev->base_addr = (unsigned long)priv->hw_base;
James Ketrenos43f66a62005-03-25 12:31:53 -060011585 net_dev->mem_start = pci_resource_start(pdev, 0);
11586 net_dev->mem_end = net_dev->mem_start + pci_resource_len(pdev, 0) - 1;
11587
11588 err = sysfs_create_group(&pdev->dev.kobj, &ipw_attribute_group);
11589 if (err) {
11590 IPW_ERROR("failed to create sysfs device attributes\n");
Zhu Yi46441512006-01-24 16:37:59 +080011591 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011592 goto out_release_irq;
11593 }
11594
Zhu Yi46441512006-01-24 16:37:59 +080011595 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011596 err = register_netdev(net_dev);
11597 if (err) {
11598 IPW_ERROR("failed to register network device\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011599 goto out_remove_sysfs;
James Ketrenos43f66a62005-03-25 12:31:53 -060011600 }
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011601
Zhu Yid685b8c2006-04-13 17:20:27 +080011602#ifdef CONFIG_IPW2200_PROMISCUOUS
11603 if (rtap_iface) {
11604 err = ipw_prom_alloc(priv);
11605 if (err) {
11606 IPW_ERROR("Failed to register promiscuous network "
11607 "device (error %d).\n", err);
11608 unregister_netdev(priv->net_dev);
11609 goto out_remove_sysfs;
11610 }
11611 }
11612#endif
11613
Henrik Brix Andersen48a84772006-02-14 09:09:52 +080011614 printk(KERN_INFO DRV_NAME ": Detected geography %s (%d 802.11bg "
11615 "channels, %d 802.11a channels)\n",
11616 priv->ieee->geo.name, priv->ieee->geo.bg_channels,
11617 priv->ieee->geo.a_channels);
11618
James Ketrenos43f66a62005-03-25 12:31:53 -060011619 return 0;
11620
James Ketrenosa613bff2005-08-24 21:43:11 -050011621 out_remove_sysfs:
James Ketrenos43f66a62005-03-25 12:31:53 -060011622 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011623 out_release_irq:
James Ketrenos43f66a62005-03-25 12:31:53 -060011624 free_irq(pdev->irq, priv);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011625 out_destroy_workqueue:
James Ketrenos43f66a62005-03-25 12:31:53 -060011626 destroy_workqueue(priv->workqueue);
11627 priv->workqueue = NULL;
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011628 out_iounmap:
James Ketrenos43f66a62005-03-25 12:31:53 -060011629 iounmap(priv->hw_base);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011630 out_pci_release_regions:
James Ketrenos43f66a62005-03-25 12:31:53 -060011631 pci_release_regions(pdev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011632 out_pci_disable_device:
James Ketrenos43f66a62005-03-25 12:31:53 -060011633 pci_disable_device(pdev);
11634 pci_set_drvdata(pdev, NULL);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011635 out_free_ieee80211:
James Ketrenos43f66a62005-03-25 12:31:53 -060011636 free_ieee80211(priv->net_dev);
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011637 out:
James Ketrenos43f66a62005-03-25 12:31:53 -060011638 return err;
11639}
11640
11641static void ipw_pci_remove(struct pci_dev *pdev)
11642{
11643 struct ipw_priv *priv = pci_get_drvdata(pdev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011644 struct list_head *p, *q;
11645 int i;
James Ketrenosb095c382005-08-24 22:04:42 -050011646
James Ketrenos43f66a62005-03-25 12:31:53 -060011647 if (!priv)
11648 return;
11649
Zhu Yi46441512006-01-24 16:37:59 +080011650 mutex_lock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011651
James Ketrenosafbf30a2005-08-25 00:05:33 -050011652 priv->status |= STATUS_EXIT_PENDING;
James Ketrenos43f66a62005-03-25 12:31:53 -060011653 ipw_down(priv);
James Ketrenos43f66a62005-03-25 12:31:53 -060011654 sysfs_remove_group(&pdev->dev.kobj, &ipw_attribute_group);
11655
Zhu Yi46441512006-01-24 16:37:59 +080011656 mutex_unlock(&priv->mutex);
James Ketrenos43f66a62005-03-25 12:31:53 -060011657
11658 unregister_netdev(priv->net_dev);
11659
11660 if (priv->rxq) {
11661 ipw_rx_queue_free(priv, priv->rxq);
11662 priv->rxq = NULL;
11663 }
11664 ipw_tx_queue_free(priv);
11665
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011666 if (priv->cmdlog) {
11667 kfree(priv->cmdlog);
11668 priv->cmdlog = NULL;
11669 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011670 /* ipw_down will ensure that there is no more pending work
11671 * in the workqueue's, so we can safely remove them now. */
James Ketrenosa613bff2005-08-24 21:43:11 -050011672 cancel_delayed_work(&priv->adhoc_check);
11673 cancel_delayed_work(&priv->gather_stats);
11674 cancel_delayed_work(&priv->request_scan);
11675 cancel_delayed_work(&priv->rf_kill);
11676 cancel_delayed_work(&priv->scan_check);
11677 destroy_workqueue(priv->workqueue);
11678 priv->workqueue = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011679
James Ketrenosafbf30a2005-08-25 00:05:33 -050011680 /* Free MAC hash list for ADHOC */
11681 for (i = 0; i < IPW_IBSS_MAC_HASH_SIZE; i++) {
11682 list_for_each_safe(p, q, &priv->ibss_mac_hash[i]) {
James Ketrenosafbf30a2005-08-25 00:05:33 -050011683 list_del(p);
Zhu Yi489f4452006-01-24 16:37:41 +080011684 kfree(list_entry(p, struct ipw_ibss_seq, list));
James Ketrenosafbf30a2005-08-25 00:05:33 -050011685 }
11686 }
11687
Jesper Juhl8f760782006-06-27 02:55:06 -070011688 kfree(priv->error);
11689 priv->error = NULL;
James Ketrenos43f66a62005-03-25 12:31:53 -060011690
Zhu Yid685b8c2006-04-13 17:20:27 +080011691#ifdef CONFIG_IPW2200_PROMISCUOUS
11692 ipw_prom_free(priv);
11693#endif
11694
James Ketrenos43f66a62005-03-25 12:31:53 -060011695 free_irq(pdev->irq, priv);
11696 iounmap(priv->hw_base);
11697 pci_release_regions(pdev);
11698 pci_disable_device(pdev);
11699 pci_set_drvdata(pdev, NULL);
11700 free_ieee80211(priv->net_dev);
James Ketrenosafbf30a2005-08-25 00:05:33 -050011701 free_firmware();
James Ketrenos43f66a62005-03-25 12:31:53 -060011702}
11703
James Ketrenos43f66a62005-03-25 12:31:53 -060011704#ifdef CONFIG_PM
Pavel Machek583a4e82005-09-03 15:56:58 -070011705static int ipw_pci_suspend(struct pci_dev *pdev, pm_message_t state)
James Ketrenos43f66a62005-03-25 12:31:53 -060011706{
11707 struct ipw_priv *priv = pci_get_drvdata(pdev);
11708 struct net_device *dev = priv->net_dev;
11709
11710 printk(KERN_INFO "%s: Going into suspend...\n", dev->name);
11711
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011712 /* Take down the device; powers it off, etc. */
James Ketrenos43f66a62005-03-25 12:31:53 -060011713 ipw_down(priv);
11714
11715 /* Remove the PRESENT state of the device */
11716 netif_device_detach(dev);
11717
James Ketrenos43f66a62005-03-25 12:31:53 -060011718 pci_save_state(pdev);
James Ketrenos43f66a62005-03-25 12:31:53 -060011719 pci_disable_device(pdev);
Pavel Machek583a4e82005-09-03 15:56:58 -070011720 pci_set_power_state(pdev, pci_choose_state(pdev, state));
Jeff Garzikbf794512005-07-31 13:07:26 -040011721
James Ketrenos43f66a62005-03-25 12:31:53 -060011722 return 0;
11723}
11724
11725static int ipw_pci_resume(struct pci_dev *pdev)
11726{
11727 struct ipw_priv *priv = pci_get_drvdata(pdev);
11728 struct net_device *dev = priv->net_dev;
John W. Linville02e0e5e2006-11-07 20:53:48 -050011729 int err;
James Ketrenos43f66a62005-03-25 12:31:53 -060011730 u32 val;
Jeff Garzikbf794512005-07-31 13:07:26 -040011731
James Ketrenos43f66a62005-03-25 12:31:53 -060011732 printk(KERN_INFO "%s: Coming out of suspend...\n", dev->name);
11733
James Ketrenosea2b26e2005-08-24 21:25:16 -050011734 pci_set_power_state(pdev, PCI_D0);
John W. Linville02e0e5e2006-11-07 20:53:48 -050011735 err = pci_enable_device(pdev);
11736 if (err) {
11737 printk(KERN_ERR "%s: pci_enable_device failed on resume\n",
11738 dev->name);
11739 return err;
11740 }
James Ketrenos43f66a62005-03-25 12:31:53 -060011741 pci_restore_state(pdev);
James Ketrenosea2b26e2005-08-24 21:25:16 -050011742
James Ketrenos43f66a62005-03-25 12:31:53 -060011743 /*
11744 * Suspend/Resume resets the PCI configuration space, so we have to
11745 * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries
11746 * from interfering with C3 CPU state. pci_restore_state won't help
11747 * here since it only restores the first 64 bytes pci config header.
11748 */
Jeff Garzikbf794512005-07-31 13:07:26 -040011749 pci_read_config_dword(pdev, 0x40, &val);
11750 if ((val & 0x0000ff00) != 0)
James Ketrenos43f66a62005-03-25 12:31:53 -060011751 pci_write_config_dword(pdev, 0x40, val & 0xffff00ff);
11752
11753 /* Set the device back into the PRESENT state; this will also wake
11754 * the queue of needed */
11755 netif_device_attach(dev);
11756
11757 /* Bring the device back up */
11758 queue_work(priv->workqueue, &priv->up);
Jeff Garzikbf794512005-07-31 13:07:26 -040011759
James Ketrenos43f66a62005-03-25 12:31:53 -060011760 return 0;
11761}
11762#endif
11763
Zhu Yic8c22c92006-08-21 11:38:39 +080011764static void ipw_pci_shutdown(struct pci_dev *pdev)
11765{
11766 struct ipw_priv *priv = pci_get_drvdata(pdev);
11767
11768 /* Take down the device; powers it off, etc. */
11769 ipw_down(priv);
11770
11771 pci_disable_device(pdev);
11772}
11773
James Ketrenos43f66a62005-03-25 12:31:53 -060011774/* driver initialization stuff */
11775static struct pci_driver ipw_driver = {
11776 .name = DRV_NAME,
11777 .id_table = card_ids,
11778 .probe = ipw_pci_probe,
11779 .remove = __devexit_p(ipw_pci_remove),
11780#ifdef CONFIG_PM
11781 .suspend = ipw_pci_suspend,
11782 .resume = ipw_pci_resume,
11783#endif
Zhu Yic8c22c92006-08-21 11:38:39 +080011784 .shutdown = ipw_pci_shutdown,
James Ketrenos43f66a62005-03-25 12:31:53 -060011785};
11786
11787static int __init ipw_init(void)
11788{
11789 int ret;
11790
11791 printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
11792 printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
11793
Jeff Garzik29917622006-08-19 17:48:59 -040011794 ret = pci_register_driver(&ipw_driver);
James Ketrenos43f66a62005-03-25 12:31:53 -060011795 if (ret) {
11796 IPW_ERROR("Unable to initialize PCI module\n");
11797 return ret;
11798 }
11799
Jeff Garzik0edd5b42005-09-07 00:48:31 -040011800 ret = driver_create_file(&ipw_driver.driver, &driver_attr_debug_level);
James Ketrenos43f66a62005-03-25 12:31:53 -060011801 if (ret) {
11802 IPW_ERROR("Unable to create driver sysfs file\n");
11803 pci_unregister_driver(&ipw_driver);
11804 return ret;
11805 }
11806
11807 return ret;
11808}
11809
11810static void __exit ipw_exit(void)
11811{
11812 driver_remove_file(&ipw_driver.driver, &driver_attr_debug_level);
11813 pci_unregister_driver(&ipw_driver);
11814}
11815
11816module_param(disable, int, 0444);
11817MODULE_PARM_DESC(disable, "manually disable the radio (default 0 [radio on])");
11818
11819module_param(associate, int, 0444);
11820MODULE_PARM_DESC(associate, "auto associate when scanning (default on)");
11821
11822module_param(auto_create, int, 0444);
11823MODULE_PARM_DESC(auto_create, "auto create adhoc network (default on)");
11824
James Ketrenosa613bff2005-08-24 21:43:11 -050011825module_param(led, int, 0444);
James Ketrenosc848d0a2005-08-24 21:56:24 -050011826MODULE_PARM_DESC(led, "enable led control on some systems (default 0 off)\n");
James Ketrenosa613bff2005-08-24 21:43:11 -050011827
James Ketrenos43f66a62005-03-25 12:31:53 -060011828module_param(debug, int, 0444);
11829MODULE_PARM_DESC(debug, "debug output mask");
11830
11831module_param(channel, int, 0444);
Jeff Garzikbf794512005-07-31 13:07:26 -040011832MODULE_PARM_DESC(channel, "channel to limit associate to (default 0 [ANY])");
James Ketrenos43f66a62005-03-25 12:31:53 -060011833
Zhu Yid685b8c2006-04-13 17:20:27 +080011834#ifdef CONFIG_IPW2200_PROMISCUOUS
11835module_param(rtap_iface, int, 0444);
11836MODULE_PARM_DESC(rtap_iface, "create the rtap interface (1 - create, default 0)");
11837#endif
11838
Zhu Yie43e3c12006-04-13 17:20:45 +080011839#ifdef CONFIG_IPW2200_QOS
James Ketrenosb095c382005-08-24 22:04:42 -050011840module_param(qos_enable, int, 0444);
11841MODULE_PARM_DESC(qos_enable, "enable all QoS functionalitis");
James Ketrenos43f66a62005-03-25 12:31:53 -060011842
James Ketrenosb095c382005-08-24 22:04:42 -050011843module_param(qos_burst_enable, int, 0444);
11844MODULE_PARM_DESC(qos_burst_enable, "enable QoS burst mode");
11845
11846module_param(qos_no_ack_mask, int, 0444);
11847MODULE_PARM_DESC(qos_no_ack_mask, "mask Tx_Queue to no ack");
11848
11849module_param(burst_duration_CCK, int, 0444);
11850MODULE_PARM_DESC(burst_duration_CCK, "set CCK burst value");
11851
11852module_param(burst_duration_OFDM, int, 0444);
11853MODULE_PARM_DESC(burst_duration_OFDM, "set OFDM burst value");
Zhu Yie43e3c12006-04-13 17:20:45 +080011854#endif /* CONFIG_IPW2200_QOS */
James Ketrenosb095c382005-08-24 22:04:42 -050011855
11856#ifdef CONFIG_IPW2200_MONITOR
James Ketrenos43f66a62005-03-25 12:31:53 -060011857module_param(mode, int, 0444);
11858MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS,2=Monitor)");
11859#else
11860module_param(mode, int, 0444);
11861MODULE_PARM_DESC(mode, "network mode (0=BSS,1=IBSS)");
11862#endif
11863
Zhu Yi810dabd2006-01-24 16:36:59 +080011864module_param(bt_coexist, int, 0444);
11865MODULE_PARM_DESC(bt_coexist, "enable bluetooth coexistence (default off)");
11866
James Ketrenosb095c382005-08-24 22:04:42 -050011867module_param(hwcrypto, int, 0444);
Zhu Yibde37d02006-01-24 16:38:08 +080011868MODULE_PARM_DESC(hwcrypto, "enable hardware crypto (default off)");
James Ketrenosb095c382005-08-24 22:04:42 -050011869
James Ketrenosf6c5cb72005-08-25 00:39:09 -050011870module_param(cmdlog, int, 0444);
11871MODULE_PARM_DESC(cmdlog,
11872 "allocate a ring buffer for logging firmware commands");
11873
Zhu Yi4bfdb912006-01-24 16:37:16 +080011874module_param(roaming, int, 0444);
11875MODULE_PARM_DESC(roaming, "enable roaming support (default on)");
11876
Zhu Yid2b83e12006-04-13 17:19:36 +080011877module_param(antenna, int, 0444);
11878MODULE_PARM_DESC(antenna, "select antenna 1=Main, 3=Aux, default 0 [both], 2=slow_diversity (choose the one with lower background noise)");
11879
James Ketrenos43f66a62005-03-25 12:31:53 -060011880module_exit(ipw_exit);
11881module_init(ipw_init);