blob: d3714f076a0c776970889e50c87ca75f88ecef75 [file] [log] [blame]
Zhu Yib481de92007-09-25 17:54:57 -07001/******************************************************************************
2 *
Reinette Chatre1f447802010-01-15 13:43:41 -08003 * Copyright(c) 2003 - 2010 Intel Corporation. All rights reserved.
Zhu Yib481de92007-09-25 17:54:57 -07004 *
5 * Portions of this file are derived from the ipw3945 project, as well
6 * as portions of the ieee80211 subsystem header files.
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of version 2 of the GNU General Public License as
10 * published by the Free Software Foundation.
11 *
12 * This program is distributed in the hope that it will be useful, but WITHOUT
13 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
14 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
15 * more details.
16 *
17 * You should have received a copy of the GNU General Public License along with
18 * this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
20 *
21 * The full GNU General Public License is included in this distribution in the
22 * file called LICENSE.
23 *
24 * Contact Information:
Winkler, Tomas759ef892008-12-09 11:28:58 -080025 * Intel Linux Wireless <ilw@linux.intel.com>
Zhu Yib481de92007-09-25 17:54:57 -070026 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
27 *
28 *****************************************************************************/
29
Joe Perchesc96c31e2010-07-26 14:39:58 -070030#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
31
Zhu Yib481de92007-09-25 17:54:57 -070032#include <linux/kernel.h>
33#include <linux/module.h>
Zhu Yib481de92007-09-25 17:54:57 -070034#include <linux/init.h>
35#include <linux/pci.h>
John W. Linville1a7123c2010-08-05 14:39:31 -040036#include <linux/pci-aspm.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090037#include <linux/slab.h>
Zhu Yib481de92007-09-25 17:54:57 -070038#include <linux/dma-mapping.h>
39#include <linux/delay.h>
Alexey Dobriyand43c36d2009-10-07 17:09:06 +040040#include <linux/sched.h>
Zhu Yib481de92007-09-25 17:54:57 -070041#include <linux/skbuff.h>
42#include <linux/netdevice.h>
43#include <linux/wireless.h>
44#include <linux/firmware.h>
Zhu Yib481de92007-09-25 17:54:57 -070045#include <linux/etherdevice.h>
46#include <linux/if_arp.h>
47
Zhu Yib481de92007-09-25 17:54:57 -070048#include <net/mac80211.h>
49
50#include <asm/div64.h>
51
Samuel Ortiza3139c52008-12-19 10:37:09 +080052#define DRV_NAME "iwlagn"
53
Assaf Krauss6bc913b2008-03-11 16:17:18 -070054#include "iwl-eeprom.h"
Tomas Winkler3e0d4cb2008-04-24 11:55:38 -070055#include "iwl-dev.h"
Tomas Winklerfee12472008-04-03 16:05:21 -070056#include "iwl-core.h"
Tomas Winkler3395f6e2008-03-25 16:33:37 -070057#include "iwl-io.h"
Zhu Yib481de92007-09-25 17:54:57 -070058#include "iwl-helpers.h"
Emmanuel Grumbach6974e362008-04-14 21:16:06 -070059#include "iwl-sta.h"
Emmanuel Grumbachf0832f12008-04-16 16:34:47 -070060#include "iwl-calib.h"
Johannes Berga1175122010-01-21 06:21:10 -080061#include "iwl-agn.h"
Zhu Yib481de92007-09-25 17:54:57 -070062
Christoph Hellwig416e1432007-10-25 17:15:49 +080063
Zhu Yib481de92007-09-25 17:54:57 -070064/******************************************************************************
65 *
66 * module boiler plate
67 *
68 ******************************************************************************/
69
Zhu Yib481de92007-09-25 17:54:57 -070070/*
71 * module name, copyright, version, etc.
Zhu Yib481de92007-09-25 17:54:57 -070072 */
Tomas Winklerd783b062008-07-18 13:53:02 +080073#define DRV_DESCRIPTION "Intel(R) Wireless WiFi Link AGN driver for Linux"
Zhu Yib481de92007-09-25 17:54:57 -070074
Tomas Winkler0a6857e2008-03-12 16:58:49 -070075#ifdef CONFIG_IWLWIFI_DEBUG
Zhu Yib481de92007-09-25 17:54:57 -070076#define VD "d"
77#else
78#define VD
79#endif
80
Reinette Chatre81963d62010-01-22 14:22:57 -080081#define DRV_VERSION IWLWIFI_VERSION VD
Zhu Yib481de92007-09-25 17:54:57 -070082
Zhu Yib481de92007-09-25 17:54:57 -070083
84MODULE_DESCRIPTION(DRV_DESCRIPTION);
85MODULE_VERSION(DRV_VERSION);
Tomas Winklera7b75202008-12-11 10:33:41 -080086MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
Zhu Yib481de92007-09-25 17:54:57 -070087MODULE_LICENSE("GPL");
Tomas Winkler4fc22b22008-07-21 18:54:42 +030088MODULE_ALIAS("iwl4965");
Zhu Yib481de92007-09-25 17:54:57 -070089
Wey-Yi Guybee008b2010-08-23 07:57:04 -070090static int iwlagn_ant_coupling;
Wey-Yi Guyf37837c2010-08-23 07:57:12 -070091static bool iwlagn_bt_ch_announce = 1;
Wey-Yi Guybee008b2010-08-23 07:57:04 -070092
Zhu Yib481de92007-09-25 17:54:57 -070093/**
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -070094 * iwl_commit_rxon - commit staging_rxon to hardware
Zhu Yib481de92007-09-25 17:54:57 -070095 *
Ian Schram01ebd062007-10-25 17:15:22 +080096 * The RXON command in staging_rxon is committed to the hardware and
Zhu Yib481de92007-09-25 17:54:57 -070097 * the active_rxon structure is updated with the new data. This
98 * function correctly transitions out of the RXON_ASSOC_MSK state if
99 * a HW tune is required based on the RXON structure changes.
100 */
Johannes Berg246ed352010-08-23 10:46:32 +0200101int iwl_commit_rxon(struct iwl_priv *priv, struct iwl_rxon_context *ctx)
Zhu Yib481de92007-09-25 17:54:57 -0700102{
103 /* cast away the const for active_rxon in this function */
Johannes Berg246ed352010-08-23 10:46:32 +0200104 struct iwl_rxon_cmd *active_rxon = (void *)&ctx->active;
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800105 int ret;
106 bool new_assoc =
Johannes Berg246ed352010-08-23 10:46:32 +0200107 !!(ctx->staging.filter_flags & RXON_FILTER_ASSOC_MSK);
Zhu Yib481de92007-09-25 17:54:57 -0700108
Tomas Winklerfee12472008-04-03 16:05:21 -0700109 if (!iwl_is_alive(priv))
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800110 return -EBUSY;
Zhu Yib481de92007-09-25 17:54:57 -0700111
112 /* always get timestamp with Rx frame */
Johannes Berg246ed352010-08-23 10:46:32 +0200113 ctx->staging.flags |= RXON_FLG_TSF2HOST_MSK;
Zhu Yib481de92007-09-25 17:54:57 -0700114
Johannes Berg246ed352010-08-23 10:46:32 +0200115 ret = iwl_check_rxon_cmd(priv, ctx);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800116 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800117 IWL_ERR(priv, "Invalid RXON configuration. Not committing.\n");
Zhu Yib481de92007-09-25 17:54:57 -0700118 return -EINVAL;
119 }
120
Wey-Yi Guy0924e5192009-11-06 14:52:54 -0800121 /*
122 * receive commit_rxon request
123 * abort any previous channel switch if still in process
124 */
125 if (priv->switch_rxon.switch_in_progress &&
Johannes Berg246ed352010-08-23 10:46:32 +0200126 (priv->switch_rxon.channel != ctx->staging.channel)) {
Wey-Yi Guy0924e5192009-11-06 14:52:54 -0800127 IWL_DEBUG_11H(priv, "abort channel switch on %d\n",
128 le16_to_cpu(priv->switch_rxon.channel));
Wey-Yi Guy79d07322010-05-06 08:54:11 -0700129 iwl_chswitch_done(priv, false);
Wey-Yi Guy0924e5192009-11-06 14:52:54 -0800130 }
131
Zhu Yib481de92007-09-25 17:54:57 -0700132 /* If we don't need to send a full RXON, we can use
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700133 * iwl_rxon_assoc_cmd which is used to reconfigure filter
Zhu Yib481de92007-09-25 17:54:57 -0700134 * and other flags for the current radio configuration. */
Johannes Berg246ed352010-08-23 10:46:32 +0200135 if (!iwl_full_rxon_required(priv, ctx)) {
136 ret = iwl_send_rxon_assoc(priv, ctx);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800137 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800138 IWL_ERR(priv, "Error setting RXON_ASSOC (%d)\n", ret);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800139 return ret;
Zhu Yib481de92007-09-25 17:54:57 -0700140 }
141
Johannes Berg246ed352010-08-23 10:46:32 +0200142 memcpy(active_rxon, &ctx->staging, sizeof(*active_rxon));
143 iwl_print_rx_config_cmd(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -0700144 return 0;
145 }
146
Zhu Yib481de92007-09-25 17:54:57 -0700147 /* If we are currently associated and the new config requires
148 * an RXON_ASSOC and the new config wants the associated mask enabled,
149 * we must clear the associated from the active configuration
150 * before we apply the new config */
Johannes Berg246ed352010-08-23 10:46:32 +0200151 if (iwl_is_associated_ctx(ctx) && new_assoc) {
Tomas Winklere1623442009-01-27 14:27:56 -0800152 IWL_DEBUG_INFO(priv, "Toggling associated bit on current RXON\n");
Zhu Yib481de92007-09-25 17:54:57 -0700153 active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
154
Johannes Berg8f2d3d22010-08-23 10:46:37 +0200155 ret = iwl_send_cmd_pdu(priv, ctx->rxon_cmd,
Johannes Berg246ed352010-08-23 10:46:32 +0200156 sizeof(struct iwl_rxon_cmd),
157 active_rxon);
Zhu Yib481de92007-09-25 17:54:57 -0700158
159 /* If the mask clearing failed then we set
160 * active_rxon back to what it was previously */
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800161 if (ret) {
Zhu Yib481de92007-09-25 17:54:57 -0700162 active_rxon->filter_flags |= RXON_FILTER_ASSOC_MSK;
Winkler, Tomas15b16872008-12-19 10:37:33 +0800163 IWL_ERR(priv, "Error clearing ASSOC_MSK (%d)\n", ret);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800164 return ret;
Zhu Yib481de92007-09-25 17:54:57 -0700165 }
Johannes Bergdcef7322010-08-27 08:55:52 -0700166 iwl_clear_ucode_stations(priv, ctx);
167 iwl_restore_stations(priv, ctx);
Johannes Berg335348b2010-03-30 10:11:46 -0700168 ret = iwl_restore_default_wep_keys(priv);
169 if (ret) {
170 IWL_ERR(priv, "Failed to restore WEP keys (%d)\n", ret);
171 return ret;
172 }
Zhu Yib481de92007-09-25 17:54:57 -0700173 }
174
Tomas Winklere1623442009-01-27 14:27:56 -0800175 IWL_DEBUG_INFO(priv, "Sending RXON\n"
Zhu Yib481de92007-09-25 17:54:57 -0700176 "* with%s RXON_FILTER_ASSOC_MSK\n"
177 "* channel = %d\n"
Johannes Berge1749612008-10-27 15:59:26 -0700178 "* bssid = %pM\n",
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800179 (new_assoc ? "" : "out"),
Johannes Berg246ed352010-08-23 10:46:32 +0200180 le16_to_cpu(ctx->staging.channel),
181 ctx->staging.bssid_addr);
Zhu Yib481de92007-09-25 17:54:57 -0700182
Johannes Berg246ed352010-08-23 10:46:32 +0200183 iwl_set_rxon_hwcrypto(priv, ctx, !priv->cfg->mod_params->sw_crypto);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800184
185 /* Apply the new configuration
Reinette Chatre7e246192010-02-18 22:58:32 -0800186 * RXON unassoc clears the station table in uCode so restoration of
187 * stations is needed after it (the RXON command) completes
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800188 */
189 if (!new_assoc) {
Johannes Berg8f2d3d22010-08-23 10:46:37 +0200190 ret = iwl_send_cmd_pdu(priv, ctx->rxon_cmd,
Johannes Berg246ed352010-08-23 10:46:32 +0200191 sizeof(struct iwl_rxon_cmd), &ctx->staging);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800192 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800193 IWL_ERR(priv, "Error setting new RXON (%d)\n", ret);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800194 return ret;
195 }
Frans Pop91dd6c22010-03-24 14:19:58 -0700196 IWL_DEBUG_INFO(priv, "Return from !new_assoc RXON.\n");
Johannes Berg246ed352010-08-23 10:46:32 +0200197 memcpy(active_rxon, &ctx->staging, sizeof(*active_rxon));
Johannes Bergdcef7322010-08-27 08:55:52 -0700198 iwl_clear_ucode_stations(priv, ctx);
199 iwl_restore_stations(priv, ctx);
Johannes Berg335348b2010-03-30 10:11:46 -0700200 ret = iwl_restore_default_wep_keys(priv);
201 if (ret) {
202 IWL_ERR(priv, "Failed to restore WEP keys (%d)\n", ret);
203 return ret;
204 }
Zhu Yib481de92007-09-25 17:54:57 -0700205 }
206
Johannes Berg19cc1082009-05-08 13:44:36 -0700207 priv->start_calib = 0;
Tomas Winkler91851592008-06-30 17:23:14 +0800208 if (new_assoc) {
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800209 /* Apply the new configuration
210 * RXON assoc doesn't clear the station table in uCode,
211 */
Johannes Berg8f2d3d22010-08-23 10:46:37 +0200212 ret = iwl_send_cmd_pdu(priv, ctx->rxon_cmd,
Johannes Berg246ed352010-08-23 10:46:32 +0200213 sizeof(struct iwl_rxon_cmd), &ctx->staging);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800214 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800215 IWL_ERR(priv, "Error setting new RXON (%d)\n", ret);
Emmanuel Grumbach43d59b32008-06-30 17:23:06 +0800216 return ret;
217 }
Johannes Berg246ed352010-08-23 10:46:32 +0200218 memcpy(active_rxon, &ctx->staging, sizeof(*active_rxon));
Zhu Yib481de92007-09-25 17:54:57 -0700219 }
Johannes Berg246ed352010-08-23 10:46:32 +0200220 iwl_print_rx_config_cmd(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -0700221
Zhu Yi36da7d72008-07-11 11:53:40 +0800222 iwl_init_sensitivity(priv);
223
224 /* If we issue a new RXON command which required a tune then we must
225 * send a new TXPOWER command or we won't be able to Tx any frames */
226 ret = iwl_set_tx_power(priv, priv->tx_power_user_lmt, true);
227 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800228 IWL_ERR(priv, "Error sending TX power (%d)\n", ret);
Zhu Yi36da7d72008-07-11 11:53:40 +0800229 return ret;
230 }
231
Zhu Yib481de92007-09-25 17:54:57 -0700232 return 0;
233}
234
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700235void iwl_update_chain_flags(struct iwl_priv *priv)
Mohamed Abbas5da4b552008-04-21 15:41:51 -0700236{
Johannes Berg246ed352010-08-23 10:46:32 +0200237 struct iwl_rxon_context *ctx;
Mohamed Abbas5da4b552008-04-21 15:41:51 -0700238
Johannes Berg246ed352010-08-23 10:46:32 +0200239 if (priv->cfg->ops->hcmd->set_rxon_chain) {
240 for_each_context(priv, ctx) {
241 priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
242 iwlcore_commit_rxon(priv, ctx);
243 }
244 }
Mohamed Abbas5da4b552008-04-21 15:41:51 -0700245}
246
Tomas Winklerfcab4232008-05-15 13:54:01 +0800247static void iwl_clear_free_frames(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -0700248{
249 struct list_head *element;
250
Tomas Winklere1623442009-01-27 14:27:56 -0800251 IWL_DEBUG_INFO(priv, "%d frames on pre-allocated heap on clear.\n",
Zhu Yib481de92007-09-25 17:54:57 -0700252 priv->frames_count);
253
254 while (!list_empty(&priv->free_frames)) {
255 element = priv->free_frames.next;
256 list_del(element);
Tomas Winklerfcab4232008-05-15 13:54:01 +0800257 kfree(list_entry(element, struct iwl_frame, list));
Zhu Yib481de92007-09-25 17:54:57 -0700258 priv->frames_count--;
259 }
260
261 if (priv->frames_count) {
Winkler, Tomas39aadf82008-12-19 10:37:32 +0800262 IWL_WARN(priv, "%d frames still in use. Did we lose one?\n",
Zhu Yib481de92007-09-25 17:54:57 -0700263 priv->frames_count);
264 priv->frames_count = 0;
265 }
266}
267
Tomas Winklerfcab4232008-05-15 13:54:01 +0800268static struct iwl_frame *iwl_get_free_frame(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -0700269{
Tomas Winklerfcab4232008-05-15 13:54:01 +0800270 struct iwl_frame *frame;
Zhu Yib481de92007-09-25 17:54:57 -0700271 struct list_head *element;
272 if (list_empty(&priv->free_frames)) {
273 frame = kzalloc(sizeof(*frame), GFP_KERNEL);
274 if (!frame) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800275 IWL_ERR(priv, "Could not allocate frame!\n");
Zhu Yib481de92007-09-25 17:54:57 -0700276 return NULL;
277 }
278
279 priv->frames_count++;
280 return frame;
281 }
282
283 element = priv->free_frames.next;
284 list_del(element);
Tomas Winklerfcab4232008-05-15 13:54:01 +0800285 return list_entry(element, struct iwl_frame, list);
Zhu Yib481de92007-09-25 17:54:57 -0700286}
287
Tomas Winklerfcab4232008-05-15 13:54:01 +0800288static void iwl_free_frame(struct iwl_priv *priv, struct iwl_frame *frame)
Zhu Yib481de92007-09-25 17:54:57 -0700289{
290 memset(frame, 0, sizeof(*frame));
291 list_add(&frame->list, &priv->free_frames);
292}
293
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800294static u32 iwl_fill_beacon_frame(struct iwl_priv *priv,
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800295 struct ieee80211_hdr *hdr,
Rami Rosen73ec1cc2008-12-16 09:37:07 +0200296 int left)
Zhu Yib481de92007-09-25 17:54:57 -0700297{
Johannes Berg6abbe552010-07-15 05:59:07 -0700298 if (!priv->ibss_beacon)
Zhu Yib481de92007-09-25 17:54:57 -0700299 return 0;
300
301 if (priv->ibss_beacon->len > left)
302 return 0;
303
304 memcpy(hdr, priv->ibss_beacon->data, priv->ibss_beacon->len);
305
306 return priv->ibss_beacon->len;
307}
308
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800309/* Parse the beacon frame to find the TIM element and set tim_idx & tim_size */
310static void iwl_set_beacon_tim(struct iwl_priv *priv,
311 struct iwl_tx_beacon_cmd *tx_beacon_cmd,
312 u8 *beacon, u32 frame_size)
313{
314 u16 tim_idx;
315 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)beacon;
316
317 /*
318 * The index is relative to frame start but we start looking at the
319 * variable-length part of the beacon.
320 */
321 tim_idx = mgmt->u.beacon.variable - beacon;
322
323 /* Parse variable-length elements of beacon to find WLAN_EID_TIM */
324 while ((tim_idx < (frame_size - 2)) &&
325 (beacon[tim_idx] != WLAN_EID_TIM))
326 tim_idx += beacon[tim_idx+1] + 2;
327
328 /* If TIM field was found, set variables */
329 if ((tim_idx < (frame_size - 1)) && (beacon[tim_idx] == WLAN_EID_TIM)) {
330 tx_beacon_cmd->tim_idx = cpu_to_le16(tim_idx);
331 tx_beacon_cmd->tim_size = beacon[tim_idx+1];
332 } else
333 IWL_WARN(priv, "Unable to find TIM Element in beacon\n");
334}
335
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700336static unsigned int iwl_hw_get_beacon_cmd(struct iwl_priv *priv,
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800337 struct iwl_frame *frame)
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800338{
339 struct iwl_tx_beacon_cmd *tx_beacon_cmd;
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800340 u32 frame_size;
341 u32 rate_flags;
342 u32 rate;
343 /*
344 * We have to set up the TX command, the TX Beacon command, and the
345 * beacon contents.
346 */
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800347
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800348 /* Initialize memory */
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800349 tx_beacon_cmd = &frame->u.beacon;
350 memset(tx_beacon_cmd, 0, sizeof(*tx_beacon_cmd));
351
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800352 /* Set up TX beacon contents */
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800353 frame_size = iwl_fill_beacon_frame(priv, tx_beacon_cmd->frame,
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800354 sizeof(frame->u) - sizeof(*tx_beacon_cmd));
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800355 if (WARN_ON_ONCE(frame_size > MAX_MPDU_SIZE))
356 return 0;
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800357
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800358 /* Set up TX command fields */
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800359 tx_beacon_cmd->tx.len = cpu_to_le16((u16)frame_size);
Johannes Berga194e322010-08-27 08:53:46 -0700360#warning "Use proper STA ID"
361 tx_beacon_cmd->tx.sta_id =
362 priv->contexts[IWL_RXON_CTX_BSS].bcast_sta_id;
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800363 tx_beacon_cmd->tx.stop_time.life_time = TX_CMD_LIFE_TIME_INFINITE;
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800364 tx_beacon_cmd->tx.tx_flags = TX_CMD_FLG_SEQ_CTL_MSK |
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800365 TX_CMD_FLG_TSF_MSK | TX_CMD_FLG_STA_RATE_MSK;
366
367 /* Set up TX beacon command fields */
368 iwl_set_beacon_tim(priv, tx_beacon_cmd, (u8 *)tx_beacon_cmd->frame,
369 frame_size);
370
371 /* Set up packet rate and flags */
372 rate = iwl_rate_get_lowest_plcp(priv);
Johannes Berg0e1654f2010-05-18 02:48:36 -0700373 priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant,
374 priv->hw_params.valid_tx_ant);
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800375 rate_flags = iwl_ant_idx_to_flags(priv->mgmt_tx_ant);
376 if ((rate >= IWL_FIRST_CCK_RATE) && (rate <= IWL_LAST_CCK_RATE))
377 rate_flags |= RATE_MCS_CCK_MSK;
378 tx_beacon_cmd->tx.rate_n_flags = iwl_hw_set_rate_n_flags(rate,
379 rate_flags);
Tomas Winkler4bf64ef2008-07-18 13:53:03 +0800380
381 return sizeof(*tx_beacon_cmd) + frame_size;
382}
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700383static int iwl_send_beacon_cmd(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -0700384{
Tomas Winklerfcab4232008-05-15 13:54:01 +0800385 struct iwl_frame *frame;
Zhu Yib481de92007-09-25 17:54:57 -0700386 unsigned int frame_size;
387 int rc;
Zhu Yib481de92007-09-25 17:54:57 -0700388
Tomas Winklerfcab4232008-05-15 13:54:01 +0800389 frame = iwl_get_free_frame(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700390 if (!frame) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800391 IWL_ERR(priv, "Could not obtain free frame buffer for beacon "
Zhu Yib481de92007-09-25 17:54:57 -0700392 "command.\n");
393 return -ENOMEM;
394 }
395
Daniel C Halperin47ff65c2009-11-13 11:56:33 -0800396 frame_size = iwl_hw_get_beacon_cmd(priv, frame);
397 if (!frame_size) {
398 IWL_ERR(priv, "Error configuring the beacon command\n");
399 iwl_free_frame(priv, frame);
400 return -EINVAL;
401 }
Zhu Yib481de92007-09-25 17:54:57 -0700402
Tomas Winkler857485c2008-03-21 13:53:44 -0700403 rc = iwl_send_cmd_pdu(priv, REPLY_TX_BEACON, frame_size,
Zhu Yib481de92007-09-25 17:54:57 -0700404 &frame->u.cmd[0]);
405
Tomas Winklerfcab4232008-05-15 13:54:01 +0800406 iwl_free_frame(priv, frame);
Zhu Yib481de92007-09-25 17:54:57 -0700407
408 return rc;
409}
410
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800411static inline dma_addr_t iwl_tfd_tb_get_addr(struct iwl_tfd *tfd, u8 idx)
412{
413 struct iwl_tfd_tb *tb = &tfd->tbs[idx];
414
415 dma_addr_t addr = get_unaligned_le32(&tb->lo);
416 if (sizeof(dma_addr_t) > sizeof(u32))
417 addr |=
418 ((dma_addr_t)(le16_to_cpu(tb->hi_n_len) & 0xF) << 16) << 16;
419
420 return addr;
421}
422
423static inline u16 iwl_tfd_tb_get_len(struct iwl_tfd *tfd, u8 idx)
424{
425 struct iwl_tfd_tb *tb = &tfd->tbs[idx];
426
427 return le16_to_cpu(tb->hi_n_len) >> 4;
428}
429
430static inline void iwl_tfd_set_tb(struct iwl_tfd *tfd, u8 idx,
431 dma_addr_t addr, u16 len)
432{
433 struct iwl_tfd_tb *tb = &tfd->tbs[idx];
434 u16 hi_n_len = len << 4;
435
436 put_unaligned_le32(addr, &tb->lo);
437 if (sizeof(dma_addr_t) > sizeof(u32))
438 hi_n_len |= ((addr >> 16) >> 16) & 0xF;
439
440 tb->hi_n_len = cpu_to_le16(hi_n_len);
441
442 tfd->num_tbs = idx + 1;
443}
444
445static inline u8 iwl_tfd_get_num_tbs(struct iwl_tfd *tfd)
446{
447 return tfd->num_tbs & 0x1f;
448}
449
450/**
451 * iwl_hw_txq_free_tfd - Free all chunks referenced by TFD [txq->q.read_ptr]
452 * @priv - driver private data
453 * @txq - tx queue
454 *
455 * Does NOT advance any TFD circular buffer read/write indexes
456 * Does NOT free the TFD itself (which is within circular buffer)
457 */
458void iwl_hw_txq_free_tfd(struct iwl_priv *priv, struct iwl_tx_queue *txq)
459{
Samuel Ortiz59606ff2009-01-23 13:45:13 -0800460 struct iwl_tfd *tfd_tmp = (struct iwl_tfd *)txq->tfds;
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800461 struct iwl_tfd *tfd;
462 struct pci_dev *dev = priv->pci_dev;
463 int index = txq->q.read_ptr;
464 int i;
465 int num_tbs;
466
467 tfd = &tfd_tmp[index];
468
469 /* Sanity check on number of chunks */
470 num_tbs = iwl_tfd_get_num_tbs(tfd);
471
472 if (num_tbs >= IWL_NUM_OF_TBS) {
473 IWL_ERR(priv, "Too many chunks: %i\n", num_tbs);
474 /* @todo issue fatal error, it is quite serious situation */
475 return;
476 }
477
478 /* Unmap tx_cmd */
479 if (num_tbs)
480 pci_unmap_single(dev,
FUJITA Tomonori2e724442010-06-03 14:19:20 +0900481 dma_unmap_addr(&txq->meta[index], mapping),
482 dma_unmap_len(&txq->meta[index], len),
Fenghua Yu96891ce2009-02-18 15:54:33 -0800483 PCI_DMA_BIDIRECTIONAL);
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800484
485 /* Unmap chunks, if any. */
Johannes Bergff0d91c2010-05-17 02:37:34 -0700486 for (i = 1; i < num_tbs; i++)
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800487 pci_unmap_single(dev, iwl_tfd_tb_get_addr(tfd, i),
488 iwl_tfd_tb_get_len(tfd, i), PCI_DMA_TODEVICE);
489
Johannes Bergff0d91c2010-05-17 02:37:34 -0700490 /* free SKB */
491 if (txq->txb) {
492 struct sk_buff *skb;
Johannes Berg6f802402010-05-17 02:37:32 -0700493
Johannes Bergff0d91c2010-05-17 02:37:34 -0700494 skb = txq->txb[txq->q.read_ptr].skb;
Johannes Berg6f802402010-05-17 02:37:32 -0700495
Johannes Bergff0d91c2010-05-17 02:37:34 -0700496 /* can be called from irqs-disabled context */
497 if (skb) {
498 dev_kfree_skb_any(skb);
499 txq->txb[txq->q.read_ptr].skb = NULL;
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800500 }
501 }
502}
503
504int iwl_hw_txq_attach_buf_to_tfd(struct iwl_priv *priv,
505 struct iwl_tx_queue *txq,
506 dma_addr_t addr, u16 len,
507 u8 reset, u8 pad)
508{
509 struct iwl_queue *q;
Samuel Ortiz59606ff2009-01-23 13:45:13 -0800510 struct iwl_tfd *tfd, *tfd_tmp;
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800511 u32 num_tbs;
512
513 q = &txq->q;
Samuel Ortiz59606ff2009-01-23 13:45:13 -0800514 tfd_tmp = (struct iwl_tfd *)txq->tfds;
515 tfd = &tfd_tmp[q->write_ptr];
Samuel Ortiz7aaa1d72009-01-19 15:30:26 -0800516
517 if (reset)
518 memset(tfd, 0, sizeof(*tfd));
519
520 num_tbs = iwl_tfd_get_num_tbs(tfd);
521
522 /* Each TFD can point to a maximum 20 Tx buffers */
523 if (num_tbs >= IWL_NUM_OF_TBS) {
524 IWL_ERR(priv, "Error can not send more than %d chunks\n",
525 IWL_NUM_OF_TBS);
526 return -EINVAL;
527 }
528
529 BUG_ON(addr & ~DMA_BIT_MASK(36));
530 if (unlikely(addr & ~IWL_TX_DMA_MASK))
531 IWL_ERR(priv, "Unaligned address = %llx\n",
532 (unsigned long long)addr);
533
534 iwl_tfd_set_tb(tfd, num_tbs, addr, len);
535
536 return 0;
537}
538
Samuel Ortiza8e74e272009-01-23 13:45:14 -0800539/*
540 * Tell nic where to find circular buffer of Tx Frame Descriptors for
541 * given Tx queue, and enable the DMA channel used for that queue.
542 *
543 * 4965 supports up to 16 Tx queues in DRAM, mapped to up to 8 Tx DMA
544 * channels supported in hardware.
545 */
546int iwl_hw_tx_queue_init(struct iwl_priv *priv,
547 struct iwl_tx_queue *txq)
548{
Samuel Ortiza8e74e272009-01-23 13:45:14 -0800549 int txq_id = txq->q.id;
550
Samuel Ortiza8e74e272009-01-23 13:45:14 -0800551 /* Circular buffer (TFD queue in DRAM) physical base address */
552 iwl_write_direct32(priv, FH_MEM_CBBC_QUEUE(txq_id),
553 txq->q.dma_addr >> 8);
554
Samuel Ortiza8e74e272009-01-23 13:45:14 -0800555 return 0;
556}
557
Zhu Yib481de92007-09-25 17:54:57 -0700558/******************************************************************************
559 *
560 * Generic RX handler implementations
561 *
562 ******************************************************************************/
Tomas Winkler885ba202008-05-29 16:34:55 +0800563static void iwl_rx_reply_alive(struct iwl_priv *priv,
564 struct iwl_rx_mem_buffer *rxb)
Zhu Yib481de92007-09-25 17:54:57 -0700565{
Zhu Yi2f301222009-10-09 17:19:45 +0800566 struct iwl_rx_packet *pkt = rxb_addr(rxb);
Tomas Winkler885ba202008-05-29 16:34:55 +0800567 struct iwl_alive_resp *palive;
Zhu Yib481de92007-09-25 17:54:57 -0700568 struct delayed_work *pwork;
569
570 palive = &pkt->u.alive_frame;
571
Tomas Winklere1623442009-01-27 14:27:56 -0800572 IWL_DEBUG_INFO(priv, "Alive ucode status 0x%08X revision "
Zhu Yib481de92007-09-25 17:54:57 -0700573 "0x%01X 0x%01X\n",
574 palive->is_valid, palive->ver_type,
575 palive->ver_subtype);
576
577 if (palive->ver_subtype == INITIALIZE_SUBTYPE) {
Tomas Winklere1623442009-01-27 14:27:56 -0800578 IWL_DEBUG_INFO(priv, "Initialization Alive received.\n");
Zhu Yib481de92007-09-25 17:54:57 -0700579 memcpy(&priv->card_alive_init,
580 &pkt->u.alive_frame,
Tomas Winkler885ba202008-05-29 16:34:55 +0800581 sizeof(struct iwl_init_alive_resp));
Zhu Yib481de92007-09-25 17:54:57 -0700582 pwork = &priv->init_alive_start;
583 } else {
Tomas Winklere1623442009-01-27 14:27:56 -0800584 IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
Zhu Yib481de92007-09-25 17:54:57 -0700585 memcpy(&priv->card_alive, &pkt->u.alive_frame,
Tomas Winkler885ba202008-05-29 16:34:55 +0800586 sizeof(struct iwl_alive_resp));
Zhu Yib481de92007-09-25 17:54:57 -0700587 pwork = &priv->alive_start;
588 }
589
590 /* We delay the ALIVE response by 5ms to
591 * give the HW RF Kill time to activate... */
592 if (palive->is_valid == UCODE_VALID_OK)
593 queue_delayed_work(priv->workqueue, pwork,
594 msecs_to_jiffies(5));
595 else
Winkler, Tomas39aadf82008-12-19 10:37:32 +0800596 IWL_WARN(priv, "uCode did not respond OK.\n");
Zhu Yib481de92007-09-25 17:54:57 -0700597}
598
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700599static void iwl_bg_beacon_update(struct work_struct *work)
Zhu Yib481de92007-09-25 17:54:57 -0700600{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -0700601 struct iwl_priv *priv =
602 container_of(work, struct iwl_priv, beacon_update);
Zhu Yib481de92007-09-25 17:54:57 -0700603 struct sk_buff *beacon;
604
605 /* Pull updated AP beacon from mac80211. will fail if not in AP mode */
Johannes Berge039fa42008-05-15 12:55:29 +0200606 beacon = ieee80211_beacon_get(priv->hw, priv->vif);
Zhu Yib481de92007-09-25 17:54:57 -0700607
608 if (!beacon) {
Winkler, Tomas15b16872008-12-19 10:37:33 +0800609 IWL_ERR(priv, "update beacon failed\n");
Zhu Yib481de92007-09-25 17:54:57 -0700610 return;
611 }
612
613 mutex_lock(&priv->mutex);
614 /* new beacon skb is allocated every time; dispose previous.*/
615 if (priv->ibss_beacon)
616 dev_kfree_skb(priv->ibss_beacon);
617
618 priv->ibss_beacon = beacon;
619 mutex_unlock(&priv->mutex);
620
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700621 iwl_send_beacon_cmd(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700622}
623
Wey-Yi Guyfbba9412010-08-23 07:57:10 -0700624static void iwl_bg_bt_runtime_config(struct work_struct *work)
625{
626 struct iwl_priv *priv =
627 container_of(work, struct iwl_priv, bt_runtime_config);
628
629 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
630 return;
631
632 /* dont send host command if rf-kill is on */
633 if (!iwl_is_ready_rf(priv))
634 return;
635 priv->cfg->ops->hcmd->send_bt_config(priv);
636}
637
Wey-Yi Guybee008b2010-08-23 07:57:04 -0700638static void iwl_bg_bt_full_concurrency(struct work_struct *work)
639{
640 struct iwl_priv *priv =
641 container_of(work, struct iwl_priv, bt_full_concurrency);
Johannes Berg246ed352010-08-23 10:46:32 +0200642 struct iwl_rxon_context *ctx;
Wey-Yi Guybee008b2010-08-23 07:57:04 -0700643
644 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
645 return;
646
647 /* dont send host command if rf-kill is on */
648 if (!iwl_is_ready_rf(priv))
649 return;
650
651 IWL_DEBUG_INFO(priv, "BT coex in %s mode\n",
652 priv->bt_full_concurrent ?
653 "full concurrency" : "3-wire");
654
655 /*
656 * LQ & RXON updated cmds must be sent before BT Config cmd
657 * to avoid 3-wire collisions
658 */
Johannes Berg246ed352010-08-23 10:46:32 +0200659 mutex_lock(&priv->mutex);
660 for_each_context(priv, ctx) {
661 if (priv->cfg->ops->hcmd->set_rxon_chain)
662 priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
663 iwlcore_commit_rxon(priv, ctx);
664 }
665 mutex_unlock(&priv->mutex);
Wey-Yi Guybee008b2010-08-23 07:57:04 -0700666
667 priv->cfg->ops->hcmd->send_bt_config(priv);
668}
669
Emmanuel Grumbach4e393172008-06-12 09:46:53 +0800670/**
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700671 * iwl_bg_statistics_periodic - Timer callback to queue statistics
Emmanuel Grumbach4e393172008-06-12 09:46:53 +0800672 *
673 * This callback is provided in order to send a statistics request.
674 *
675 * This timer function is continually reset to execute within
676 * REG_RECALIB_PERIOD seconds since the last STATISTICS_NOTIFICATION
677 * was received. We need to ensure we receive the statistics in order
678 * to update the temperature used for calibrating the TXPOWER.
679 */
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700680static void iwl_bg_statistics_periodic(unsigned long data)
Emmanuel Grumbach4e393172008-06-12 09:46:53 +0800681{
682 struct iwl_priv *priv = (struct iwl_priv *)data;
683
684 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
685 return;
686
Mohamed Abbas61780ee2008-10-29 14:05:49 -0700687 /* dont send host command if rf-kill is on */
688 if (!iwl_is_ready_rf(priv))
689 return;
690
Wey-Yi Guyef8d5522009-11-13 11:56:28 -0800691 iwl_send_statistics_request(priv, CMD_ASYNC, false);
Emmanuel Grumbach4e393172008-06-12 09:46:53 +0800692}
693
Wey-Yi Guya9e1cb62009-12-10 14:37:26 -0800694
695static void iwl_print_cont_event_trace(struct iwl_priv *priv, u32 base,
696 u32 start_idx, u32 num_events,
697 u32 mode)
698{
699 u32 i;
700 u32 ptr; /* SRAM byte address of log data */
701 u32 ev, time, data; /* event log data */
702 unsigned long reg_flags;
703
704 if (mode == 0)
705 ptr = base + (4 * sizeof(u32)) + (start_idx * 2 * sizeof(u32));
706 else
707 ptr = base + (4 * sizeof(u32)) + (start_idx * 3 * sizeof(u32));
708
709 /* Make sure device is powered up for SRAM reads */
710 spin_lock_irqsave(&priv->reg_lock, reg_flags);
711 if (iwl_grab_nic_access(priv)) {
712 spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
713 return;
714 }
715
716 /* Set starting address; reads will auto-increment */
717 _iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
718 rmb();
719
720 /*
721 * "time" is actually "data" for mode 0 (no timestamp).
722 * place event id # at far right for easier visual parsing.
723 */
724 for (i = 0; i < num_events; i++) {
725 ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
726 time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
727 if (mode == 0) {
728 trace_iwlwifi_dev_ucode_cont_event(priv,
729 0, time, ev);
730 } else {
731 data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
732 trace_iwlwifi_dev_ucode_cont_event(priv,
733 time, data, ev);
734 }
735 }
736 /* Allow device to power down */
737 iwl_release_nic_access(priv);
738 spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
739}
740
Johannes Berg875295f2010-01-22 14:22:55 -0800741static void iwl_continuous_event_trace(struct iwl_priv *priv)
Wey-Yi Guya9e1cb62009-12-10 14:37:26 -0800742{
743 u32 capacity; /* event log capacity in # entries */
744 u32 base; /* SRAM byte address of event log header */
745 u32 mode; /* 0 - no timestamp, 1 - timestamp recorded */
746 u32 num_wraps; /* # times uCode wrapped to top of log */
747 u32 next_entry; /* index of next entry to be written by uCode */
748
749 if (priv->ucode_type == UCODE_INIT)
750 base = le32_to_cpu(priv->card_alive_init.error_event_table_ptr);
751 else
752 base = le32_to_cpu(priv->card_alive.log_event_table_ptr);
753 if (priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
754 capacity = iwl_read_targ_mem(priv, base);
755 num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
756 mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
757 next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));
758 } else
759 return;
760
761 if (num_wraps == priv->event_log.num_wraps) {
762 iwl_print_cont_event_trace(priv,
763 base, priv->event_log.next_entry,
764 next_entry - priv->event_log.next_entry,
765 mode);
766 priv->event_log.non_wraps_count++;
767 } else {
768 if ((num_wraps - priv->event_log.num_wraps) > 1)
769 priv->event_log.wraps_more_count++;
770 else
771 priv->event_log.wraps_once_count++;
772 trace_iwlwifi_dev_ucode_wrap_event(priv,
773 num_wraps - priv->event_log.num_wraps,
774 next_entry, priv->event_log.next_entry);
775 if (next_entry < priv->event_log.next_entry) {
776 iwl_print_cont_event_trace(priv, base,
777 priv->event_log.next_entry,
778 capacity - priv->event_log.next_entry,
779 mode);
780
781 iwl_print_cont_event_trace(priv, base, 0,
782 next_entry, mode);
783 } else {
784 iwl_print_cont_event_trace(priv, base,
785 next_entry, capacity - next_entry,
786 mode);
787
788 iwl_print_cont_event_trace(priv, base, 0,
789 next_entry, mode);
790 }
791 }
792 priv->event_log.num_wraps = num_wraps;
793 priv->event_log.next_entry = next_entry;
794}
795
796/**
797 * iwl_bg_ucode_trace - Timer callback to log ucode event
798 *
799 * The timer is continually set to execute every
800 * UCODE_TRACE_PERIOD milliseconds after the last timer expired
801 * this function is to perform continuous uCode event logging operation
802 * if enabled
803 */
804static void iwl_bg_ucode_trace(unsigned long data)
805{
806 struct iwl_priv *priv = (struct iwl_priv *)data;
807
808 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
809 return;
810
811 if (priv->event_log.ucode_trace) {
812 iwl_continuous_event_trace(priv);
813 /* Reschedule the timer to occur in UCODE_TRACE_PERIOD */
814 mod_timer(&priv->ucode_trace,
815 jiffies + msecs_to_jiffies(UCODE_TRACE_PERIOD));
816 }
817}
818
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700819static void iwl_rx_beacon_notif(struct iwl_priv *priv,
Tomas Winklera55360e2008-05-05 10:22:28 +0800820 struct iwl_rx_mem_buffer *rxb)
Zhu Yib481de92007-09-25 17:54:57 -0700821{
Zhu Yi2f301222009-10-09 17:19:45 +0800822 struct iwl_rx_packet *pkt = rxb_addr(rxb);
Tomas Winkler2aa6ab82008-12-11 10:33:40 -0800823 struct iwl4965_beacon_notif *beacon =
824 (struct iwl4965_beacon_notif *)pkt->u.raw;
Johannes Berga85d7cc2010-07-31 08:34:10 -0700825#ifdef CONFIG_IWLWIFI_DEBUG
Tomas Winklere7d326a2008-06-12 09:47:11 +0800826 u8 rate = iwl_hw_get_rate(beacon->beacon_notify_hdr.rate_n_flags);
Zhu Yib481de92007-09-25 17:54:57 -0700827
Tomas Winklere1623442009-01-27 14:27:56 -0800828 IWL_DEBUG_RX(priv, "beacon status %x retries %d iss %d "
Zhu Yib481de92007-09-25 17:54:57 -0700829 "tsf %d %d rate %d\n",
Tomas Winkler25a65722008-06-12 09:47:07 +0800830 le32_to_cpu(beacon->beacon_notify_hdr.u.status) & TX_STATUS_MSK,
Zhu Yib481de92007-09-25 17:54:57 -0700831 beacon->beacon_notify_hdr.failure_frame,
832 le32_to_cpu(beacon->ibss_mgr_status),
833 le32_to_cpu(beacon->high_tsf),
834 le32_to_cpu(beacon->low_tsf), rate);
835#endif
836
Johannes Berga85d7cc2010-07-31 08:34:10 -0700837 priv->ibss_manager = le32_to_cpu(beacon->ibss_mgr_status);
838
Johannes Berg05c914f2008-09-11 00:01:58 +0200839 if ((priv->iw_mode == NL80211_IFTYPE_AP) &&
Zhu Yib481de92007-09-25 17:54:57 -0700840 (!test_bit(STATUS_EXIT_PENDING, &priv->status)))
841 queue_work(priv->workqueue, &priv->beacon_update);
842}
843
Zhu Yib481de92007-09-25 17:54:57 -0700844/* Handle notification from uCode that card's power state is changing
845 * due to software, hardware, or critical temperature RFKILL */
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700846static void iwl_rx_card_state_notif(struct iwl_priv *priv,
Tomas Winklera55360e2008-05-05 10:22:28 +0800847 struct iwl_rx_mem_buffer *rxb)
Zhu Yib481de92007-09-25 17:54:57 -0700848{
Zhu Yi2f301222009-10-09 17:19:45 +0800849 struct iwl_rx_packet *pkt = rxb_addr(rxb);
Zhu Yib481de92007-09-25 17:54:57 -0700850 u32 flags = le32_to_cpu(pkt->u.card_state_notif.flags);
851 unsigned long status = priv->status;
852
Wey-Yi Guy3a41bbd2009-12-10 14:37:24 -0800853 IWL_DEBUG_RF_KILL(priv, "Card state received: HW:%s SW:%s CT:%s\n",
Zhu Yib481de92007-09-25 17:54:57 -0700854 (flags & HW_CARD_DISABLED) ? "Kill" : "On",
Wey-Yi Guy3a41bbd2009-12-10 14:37:24 -0800855 (flags & SW_CARD_DISABLED) ? "Kill" : "On",
856 (flags & CT_CARD_DISABLED) ?
857 "Reached" : "Not reached");
Zhu Yib481de92007-09-25 17:54:57 -0700858
859 if (flags & (SW_CARD_DISABLED | HW_CARD_DISABLED |
Wey-Yi Guy3a41bbd2009-12-10 14:37:24 -0800860 CT_CARD_DISABLED)) {
Zhu Yib481de92007-09-25 17:54:57 -0700861
Tomas Winkler3395f6e2008-03-25 16:33:37 -0700862 iwl_write32(priv, CSR_UCODE_DRV_GP1_SET,
Zhu Yib481de92007-09-25 17:54:57 -0700863 CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
864
Mohamed Abbasa8b50a02009-05-22 11:01:47 -0700865 iwl_write_direct32(priv, HBUS_TARG_MBX_C,
866 HBUS_TARG_MBX_C_REG_BIT_CMD_BLOCKED);
Zhu Yib481de92007-09-25 17:54:57 -0700867
868 if (!(flags & RXON_CARD_DISABLED)) {
Tomas Winkler3395f6e2008-03-25 16:33:37 -0700869 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
Zhu Yib481de92007-09-25 17:54:57 -0700870 CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
Mohamed Abbasa8b50a02009-05-22 11:01:47 -0700871 iwl_write_direct32(priv, HBUS_TARG_MBX_C,
Zhu Yib481de92007-09-25 17:54:57 -0700872 HBUS_TARG_MBX_C_REG_BIT_CMD_BLOCKED);
Zhu Yib481de92007-09-25 17:54:57 -0700873 }
Wey-Yi Guy3a41bbd2009-12-10 14:37:24 -0800874 if (flags & CT_CARD_DISABLED)
Wey-Yi Guy39b73fb12009-07-24 11:13:02 -0700875 iwl_tt_enter_ct_kill(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700876 }
Wey-Yi Guy3a41bbd2009-12-10 14:37:24 -0800877 if (!(flags & CT_CARD_DISABLED))
Wey-Yi Guy39b73fb12009-07-24 11:13:02 -0700878 iwl_tt_exit_ct_kill(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700879
880 if (flags & HW_CARD_DISABLED)
881 set_bit(STATUS_RF_KILL_HW, &priv->status);
882 else
883 clear_bit(STATUS_RF_KILL_HW, &priv->status);
884
885
Zhu Yib481de92007-09-25 17:54:57 -0700886 if (!(flags & RXON_CARD_DISABLED))
Tomas Winkler2a421b92008-06-12 09:47:10 +0800887 iwl_scan_cancel(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700888
889 if ((test_bit(STATUS_RF_KILL_HW, &status) !=
Johannes Berga60e77e2009-06-04 18:26:06 +0200890 test_bit(STATUS_RF_KILL_HW, &priv->status)))
891 wiphy_rfkill_set_hw_state(priv->hw->wiphy,
892 test_bit(STATUS_RF_KILL_HW, &priv->status));
Zhu Yib481de92007-09-25 17:54:57 -0700893 else
894 wake_up_interruptible(&priv->wait_command_queue);
895}
896
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700897int iwl_set_pwr_src(struct iwl_priv *priv, enum iwl_pwr_src src)
Tomas Winklere2e3c572008-07-18 13:53:04 +0800898{
Tomas Winklere2e3c572008-07-18 13:53:04 +0800899 if (src == IWL_PWR_SRC_VAUX) {
Tomas Winkler3fdb68d2009-02-10 15:19:02 -0800900 if (pci_pme_capable(priv->pci_dev, PCI_D3cold))
Tomas Winklere2e3c572008-07-18 13:53:04 +0800901 iwl_set_bits_mask_prph(priv, APMG_PS_CTRL_REG,
902 APMG_PS_CTRL_VAL_PWR_SRC_VAUX,
903 ~APMG_PS_CTRL_MSK_PWR_SRC);
904 } else {
905 iwl_set_bits_mask_prph(priv, APMG_PS_CTRL_REG,
906 APMG_PS_CTRL_VAL_PWR_SRC_VMAIN,
907 ~APMG_PS_CTRL_MSK_PWR_SRC);
908 }
909
Mohamed Abbasa8b50a02009-05-22 11:01:47 -0700910 return 0;
Tomas Winklere2e3c572008-07-18 13:53:04 +0800911}
912
Wey-Yi Guy65550632010-06-24 13:18:35 -0700913static void iwl_bg_tx_flush(struct work_struct *work)
914{
915 struct iwl_priv *priv =
916 container_of(work, struct iwl_priv, tx_flush);
917
918 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
919 return;
920
921 /* do nothing if rf-kill is on */
922 if (!iwl_is_ready_rf(priv))
923 return;
924
925 if (priv->cfg->ops->lib->txfifo_flush) {
926 IWL_DEBUG_INFO(priv, "device request: flush all tx frames\n");
927 iwlagn_dev_txfifo_flush(priv, IWL_DROP_ALL);
928 }
929}
930
Zhu Yib481de92007-09-25 17:54:57 -0700931/**
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700932 * iwl_setup_rx_handlers - Initialize Rx handler callbacks
Zhu Yib481de92007-09-25 17:54:57 -0700933 *
934 * Setup the RX handlers for each of the reply types sent from the uCode
935 * to the host.
936 *
937 * This function chains into the hardware specific files for them to setup
938 * any hardware specific handlers as well.
939 */
Emmanuel Grumbach653fa4a2008-06-30 17:23:11 +0800940static void iwl_setup_rx_handlers(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -0700941{
Tomas Winkler885ba202008-05-29 16:34:55 +0800942 priv->rx_handlers[REPLY_ALIVE] = iwl_rx_reply_alive;
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700943 priv->rx_handlers[REPLY_ERROR] = iwl_rx_reply_error;
944 priv->rx_handlers[CHANNEL_SWITCH_NOTIFICATION] = iwl_rx_csa;
Reinette Chatre81963d62010-01-22 14:22:57 -0800945 priv->rx_handlers[SPECTRUM_MEASURE_NOTIFICATION] =
946 iwl_rx_spectrum_measure_notif;
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700947 priv->rx_handlers[PM_SLEEP_NOTIFICATION] = iwl_rx_pm_sleep_notif;
Zhu Yib481de92007-09-25 17:54:57 -0700948 priv->rx_handlers[PM_DEBUG_STATISTIC_NOTIFIC] =
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700949 iwl_rx_pm_debug_statistics_notif;
950 priv->rx_handlers[BEACON_NOTIFICATION] = iwl_rx_beacon_notif;
Zhu Yib481de92007-09-25 17:54:57 -0700951
Ben Cahill9fbab512007-11-29 11:09:47 +0800952 /*
953 * The same handler is used for both the REPLY to a discrete
954 * statistics request from the host as well as for the periodic
955 * statistics notifications (after received beacons) from the uCode.
Zhu Yib481de92007-09-25 17:54:57 -0700956 */
Wey-Yi Guyef8d5522009-11-13 11:56:28 -0800957 priv->rx_handlers[REPLY_STATISTICS_CMD] = iwl_reply_statistics;
Emmanuel Grumbach8f91aec2008-06-30 17:23:07 +0800958 priv->rx_handlers[STATISTICS_NOTIFICATION] = iwl_rx_statistics;
Tomas Winkler2a421b92008-06-12 09:47:10 +0800959
960 iwl_setup_rx_scan_handlers(priv);
961
Ron Rindjunsky37a44212008-05-29 16:35:18 +0800962 /* status change handler */
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -0700963 priv->rx_handlers[CARD_STATE_NOTIFICATION] = iwl_rx_card_state_notif;
Zhu Yib481de92007-09-25 17:54:57 -0700964
Tomas Winklerc1354752008-05-29 16:35:04 +0800965 priv->rx_handlers[MISSED_BEACONS_NOTIFICATION] =
966 iwl_rx_missed_beacon_notif;
Ron Rindjunsky37a44212008-05-29 16:35:18 +0800967 /* Rx handlers */
Wey-Yi Guy8d801082010-03-17 13:34:36 -0700968 priv->rx_handlers[REPLY_RX_PHY_CMD] = iwlagn_rx_reply_rx_phy;
969 priv->rx_handlers[REPLY_RX_MPDU_CMD] = iwlagn_rx_reply_rx;
Emmanuel Grumbach653fa4a2008-06-30 17:23:11 +0800970 /* block ack */
Wey-Yi Guy74bcdb32010-03-17 13:34:34 -0700971 priv->rx_handlers[REPLY_COMPRESSED_BA] = iwlagn_rx_reply_compressed_ba;
Ben Cahill9fbab512007-11-29 11:09:47 +0800972 /* Set up hardware specific Rx handlers */
Emmanuel Grumbachd4789ef2008-04-24 11:55:20 -0700973 priv->cfg->ops->lib->rx_handler_setup(priv);
Zhu Yib481de92007-09-25 17:54:57 -0700974}
975
Zhu Yib481de92007-09-25 17:54:57 -0700976/**
Tomas Winklera55360e2008-05-05 10:22:28 +0800977 * iwl_rx_handle - Main entry function for receiving responses from uCode
Zhu Yib481de92007-09-25 17:54:57 -0700978 *
979 * Uses the priv->rx_handlers callback function array to invoke
980 * the appropriate handlers, including command responses,
981 * frame-received notifications, and other notifications.
982 */
Tomas Winklera55360e2008-05-05 10:22:28 +0800983void iwl_rx_handle(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -0700984{
Tomas Winklera55360e2008-05-05 10:22:28 +0800985 struct iwl_rx_mem_buffer *rxb;
Tomas Winklerdb11d632008-05-05 10:22:33 +0800986 struct iwl_rx_packet *pkt;
Tomas Winklera55360e2008-05-05 10:22:28 +0800987 struct iwl_rx_queue *rxq = &priv->rxq;
Zhu Yib481de92007-09-25 17:54:57 -0700988 u32 r, i;
989 int reclaim;
990 unsigned long flags;
Mohamed Abbas5c0eef92007-11-29 11:10:14 +0800991 u8 fill_rx = 0;
Mohamed Abbasd68ab682008-02-07 13:16:33 -0800992 u32 count = 8;
Mohamed Abbas4752c932009-05-22 11:01:51 -0700993 int total_empty;
Zhu Yib481de92007-09-25 17:54:57 -0700994
Cahill, Ben M6440adb2007-11-29 11:09:55 +0800995 /* uCode's read index (stored in shared DRAM) indicates the last Rx
996 * buffer that the driver may process (last buffer filled by ucode). */
Winkler, Tomas8d864222008-11-07 09:58:39 -0800997 r = le16_to_cpu(rxq->rb_stts->closed_rb_num) & 0x0FFF;
Zhu Yib481de92007-09-25 17:54:57 -0700998 i = rxq->read;
999
1000 /* Rx interrupt, but nothing sent from uCode */
1001 if (i == r)
Tomas Winklere1623442009-01-27 14:27:56 -08001002 IWL_DEBUG_RX(priv, "r = %d, i = %d\n", r, i);
Zhu Yib481de92007-09-25 17:54:57 -07001003
Mohamed Abbas4752c932009-05-22 11:01:51 -07001004 /* calculate total frames need to be restock after handling RX */
Zhu Yi73005152009-10-23 13:42:32 -07001005 total_empty = r - rxq->write_actual;
Mohamed Abbas4752c932009-05-22 11:01:51 -07001006 if (total_empty < 0)
1007 total_empty += RX_QUEUE_SIZE;
1008
1009 if (total_empty > (RX_QUEUE_SIZE / 2))
Mohamed Abbas5c0eef92007-11-29 11:10:14 +08001010 fill_rx = 1;
1011
Zhu Yib481de92007-09-25 17:54:57 -07001012 while (i != r) {
Johannes Bergf4989d92010-05-28 04:08:30 -07001013 int len;
1014
Zhu Yib481de92007-09-25 17:54:57 -07001015 rxb = rxq->queue[i];
1016
Ben Cahill9fbab512007-11-29 11:09:47 +08001017 /* If an RXB doesn't have a Rx queue slot associated with it,
Zhu Yib481de92007-09-25 17:54:57 -07001018 * then a bug has been introduced in the queue refilling
1019 * routines -- catch it here */
1020 BUG_ON(rxb == NULL);
1021
1022 rxq->queue[i] = NULL;
1023
Zhu Yi2f301222009-10-09 17:19:45 +08001024 pci_unmap_page(priv->pci_dev, rxb->page_dma,
1025 PAGE_SIZE << priv->hw_params.rx_page_order,
1026 PCI_DMA_FROMDEVICE);
1027 pkt = rxb_addr(rxb);
Zhu Yib481de92007-09-25 17:54:57 -07001028
Johannes Bergf4989d92010-05-28 04:08:30 -07001029 len = le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK;
1030 len += sizeof(u32); /* account for status word */
1031 trace_iwlwifi_dev_rx(priv, pkt, len);
Johannes Bergbe1a71a2009-10-02 13:44:02 -07001032
Zhu Yib481de92007-09-25 17:54:57 -07001033 /* Reclaim a command buffer only if this packet is a response
1034 * to a (driver-originated) command.
1035 * If the packet (e.g. Rx frame) originated from uCode,
1036 * there is no command buffer to reclaim.
1037 * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
1038 * but apparently a few don't get set; catch them here. */
1039 reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME) &&
1040 (pkt->hdr.cmd != REPLY_RX_PHY_CMD) &&
Tomas Winkler857485c2008-03-21 13:53:44 -07001041 (pkt->hdr.cmd != REPLY_RX) &&
Daniel Halperin7dddaf12008-10-23 23:48:58 -07001042 (pkt->hdr.cmd != REPLY_RX_MPDU_CMD) &&
Zhu Yicfe01702007-09-27 11:27:31 +08001043 (pkt->hdr.cmd != REPLY_COMPRESSED_BA) &&
Zhu Yib481de92007-09-25 17:54:57 -07001044 (pkt->hdr.cmd != STATISTICS_NOTIFICATION) &&
1045 (pkt->hdr.cmd != REPLY_TX);
1046
1047 /* Based on type of command response or notification,
1048 * handle those that need handling via function in
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001049 * rx_handlers table. See iwl_setup_rx_handlers() */
Zhu Yib481de92007-09-25 17:54:57 -07001050 if (priv->rx_handlers[pkt->hdr.cmd]) {
Tomas Winklere1623442009-01-27 14:27:56 -08001051 IWL_DEBUG_RX(priv, "r = %d, i = %d, %s, 0x%02x\n", r,
Ester Kummerf3d67992008-05-06 11:05:12 +08001052 i, get_cmd_string(pkt->hdr.cmd), pkt->hdr.cmd);
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001053 priv->isr_stats.rx_handlers[pkt->hdr.cmd]++;
Zhu Yi29b1b262009-10-23 13:42:25 -07001054 priv->rx_handlers[pkt->hdr.cmd] (priv, rxb);
Zhu Yib481de92007-09-25 17:54:57 -07001055 } else {
1056 /* No handling needed */
Tomas Winklere1623442009-01-27 14:27:56 -08001057 IWL_DEBUG_RX(priv,
Zhu Yib481de92007-09-25 17:54:57 -07001058 "r %d i %d No handler needed for %s, 0x%02x\n",
1059 r, i, get_cmd_string(pkt->hdr.cmd),
1060 pkt->hdr.cmd);
1061 }
1062
Zhu Yi29b1b262009-10-23 13:42:25 -07001063 /*
1064 * XXX: After here, we should always check rxb->page
1065 * against NULL before touching it or its virtual
1066 * memory (pkt). Because some rx_handler might have
1067 * already taken or freed the pages.
1068 */
1069
Zhu Yib481de92007-09-25 17:54:57 -07001070 if (reclaim) {
Zhu Yi2f301222009-10-09 17:19:45 +08001071 /* Invoke any callbacks, transfer the buffer to caller,
1072 * and fire off the (possibly) blocking iwl_send_cmd()
Zhu Yib481de92007-09-25 17:54:57 -07001073 * as we reclaim the driver command queue */
Zhu Yi29b1b262009-10-23 13:42:25 -07001074 if (rxb->page)
Tomas Winkler17b88922008-05-29 16:35:12 +08001075 iwl_tx_cmd_complete(priv, rxb);
Zhu Yib481de92007-09-25 17:54:57 -07001076 else
Winkler, Tomas39aadf82008-12-19 10:37:32 +08001077 IWL_WARN(priv, "Claim null rxb?\n");
Zhu Yib481de92007-09-25 17:54:57 -07001078 }
1079
Zhu Yi73005152009-10-23 13:42:32 -07001080 /* Reuse the page if possible. For notification packets and
1081 * SKBs that fail to Rx correctly, add them back into the
1082 * rx_free list for reuse later. */
Zhu Yib481de92007-09-25 17:54:57 -07001083 spin_lock_irqsave(&rxq->lock, flags);
Zhu Yi73005152009-10-23 13:42:32 -07001084 if (rxb->page != NULL) {
1085 rxb->page_dma = pci_map_page(priv->pci_dev, rxb->page,
1086 0, PAGE_SIZE << priv->hw_params.rx_page_order,
1087 PCI_DMA_FROMDEVICE);
1088 list_add_tail(&rxb->list, &rxq->rx_free);
1089 rxq->free_count++;
1090 } else
1091 list_add_tail(&rxb->list, &rxq->rx_used);
1092
Zhu Yib481de92007-09-25 17:54:57 -07001093 spin_unlock_irqrestore(&rxq->lock, flags);
Zhu Yi73005152009-10-23 13:42:32 -07001094
Zhu Yib481de92007-09-25 17:54:57 -07001095 i = (i + 1) & RX_QUEUE_MASK;
Mohamed Abbas5c0eef92007-11-29 11:10:14 +08001096 /* If there are a lot of unused frames,
1097 * restock the Rx queue so ucode wont assert. */
1098 if (fill_rx) {
1099 count++;
1100 if (count >= 8) {
Zhu Yi73005152009-10-23 13:42:32 -07001101 rxq->read = i;
Wey-Yi Guy54b81552010-03-17 13:34:35 -07001102 iwlagn_rx_replenish_now(priv);
Mohamed Abbas5c0eef92007-11-29 11:10:14 +08001103 count = 0;
1104 }
1105 }
Zhu Yib481de92007-09-25 17:54:57 -07001106 }
1107
1108 /* Backtrack one entry */
Zhu Yi73005152009-10-23 13:42:32 -07001109 rxq->read = i;
Mohamed Abbas4752c932009-05-22 11:01:51 -07001110 if (fill_rx)
Wey-Yi Guy54b81552010-03-17 13:34:35 -07001111 iwlagn_rx_replenish_now(priv);
Mohamed Abbas4752c932009-05-22 11:01:51 -07001112 else
Wey-Yi Guy54b81552010-03-17 13:34:35 -07001113 iwlagn_rx_queue_restock(priv);
Tomas Winklera55360e2008-05-05 10:22:28 +08001114}
Tomas Winklera55360e2008-05-05 10:22:28 +08001115
Mohamed Abbas0359fac2008-03-28 16:21:08 -07001116/* call this function to flush any scheduled tasklet */
1117static inline void iwl_synchronize_irq(struct iwl_priv *priv)
1118{
Tomas Winklera96a27f2008-10-23 23:48:56 -07001119 /* wait to make sure we flush pending tasklet*/
Mohamed Abbas0359fac2008-03-28 16:21:08 -07001120 synchronize_irq(priv->pci_dev->irq);
1121 tasklet_kill(&priv->irq_tasklet);
1122}
1123
Mohamed Abbasef850d72009-05-22 11:01:50 -07001124static void iwl_irq_tasklet_legacy(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07001125{
1126 u32 inta, handled = 0;
1127 u32 inta_fh;
1128 unsigned long flags;
Ben Cahillc2e61da2009-10-30 14:36:09 -07001129 u32 i;
Tomas Winkler0a6857e2008-03-12 16:58:49 -07001130#ifdef CONFIG_IWLWIFI_DEBUG
Zhu Yib481de92007-09-25 17:54:57 -07001131 u32 inta_mask;
1132#endif
1133
1134 spin_lock_irqsave(&priv->lock, flags);
1135
1136 /* Ack/clear/reset pending uCode interrupts.
1137 * Note: Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
1138 * and will clear only when CSR_FH_INT_STATUS gets cleared. */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07001139 inta = iwl_read32(priv, CSR_INT);
1140 iwl_write32(priv, CSR_INT, inta);
Zhu Yib481de92007-09-25 17:54:57 -07001141
1142 /* Ack/clear/reset pending flow-handler (DMA) interrupts.
1143 * Any new interrupts that happen after this, either while we're
1144 * in this tasklet, or later, will show up in next ISR/tasklet. */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07001145 inta_fh = iwl_read32(priv, CSR_FH_INT_STATUS);
1146 iwl_write32(priv, CSR_FH_INT_STATUS, inta_fh);
Zhu Yib481de92007-09-25 17:54:57 -07001147
Tomas Winkler0a6857e2008-03-12 16:58:49 -07001148#ifdef CONFIG_IWLWIFI_DEBUG
Reinette Chatre3d816c72009-08-07 15:41:37 -07001149 if (iwl_get_debug_level(priv) & IWL_DL_ISR) {
Ben Cahill9fbab512007-11-29 11:09:47 +08001150 /* just for debug */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07001151 inta_mask = iwl_read32(priv, CSR_INT_MASK);
Tomas Winklere1623442009-01-27 14:27:56 -08001152 IWL_DEBUG_ISR(priv, "inta 0x%08x, enabled 0x%08x, fh 0x%08x\n",
Zhu Yib481de92007-09-25 17:54:57 -07001153 inta, inta_mask, inta_fh);
1154 }
1155#endif
1156
Zhu Yi2f301222009-10-09 17:19:45 +08001157 spin_unlock_irqrestore(&priv->lock, flags);
1158
Zhu Yib481de92007-09-25 17:54:57 -07001159 /* Since CSR_INT and CSR_FH_INT_STATUS reads and clears are not
1160 * atomic, make sure that inta covers all the interrupts that
1161 * we've discovered, even if FH interrupt came in just after
1162 * reading CSR_INT. */
Tomas Winkler6f83eaa2008-03-04 18:09:28 -08001163 if (inta_fh & CSR49_FH_INT_RX_MASK)
Zhu Yib481de92007-09-25 17:54:57 -07001164 inta |= CSR_INT_BIT_FH_RX;
Tomas Winkler6f83eaa2008-03-04 18:09:28 -08001165 if (inta_fh & CSR49_FH_INT_TX_MASK)
Zhu Yib481de92007-09-25 17:54:57 -07001166 inta |= CSR_INT_BIT_FH_TX;
1167
1168 /* Now service all interrupt bits discovered above. */
1169 if (inta & CSR_INT_BIT_HW_ERR) {
Reinette Chatre58dba722009-07-17 09:30:25 -07001170 IWL_ERR(priv, "Hardware error detected. Restarting.\n");
Zhu Yib481de92007-09-25 17:54:57 -07001171
1172 /* Tell the device to stop sending interrupts */
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001173 iwl_disable_interrupts(priv);
Zhu Yib481de92007-09-25 17:54:57 -07001174
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001175 priv->isr_stats.hw++;
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001176 iwl_irq_handle_error(priv);
Zhu Yib481de92007-09-25 17:54:57 -07001177
1178 handled |= CSR_INT_BIT_HW_ERR;
1179
Zhu Yib481de92007-09-25 17:54:57 -07001180 return;
1181 }
1182
Tomas Winkler0a6857e2008-03-12 16:58:49 -07001183#ifdef CONFIG_IWLWIFI_DEBUG
Reinette Chatre3d816c72009-08-07 15:41:37 -07001184 if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
Zhu Yib481de92007-09-25 17:54:57 -07001185 /* NIC fires this, but we don't use it, redundant with WAKEUP */
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001186 if (inta & CSR_INT_BIT_SCD) {
Tomas Winklere1623442009-01-27 14:27:56 -08001187 IWL_DEBUG_ISR(priv, "Scheduler finished to transmit "
Joonwoo Park25c03d82008-01-23 10:15:20 -08001188 "the frame/frames.\n");
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001189 priv->isr_stats.sch++;
1190 }
Zhu Yib481de92007-09-25 17:54:57 -07001191
1192 /* Alive notification via Rx interrupt will do the real work */
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001193 if (inta & CSR_INT_BIT_ALIVE) {
Tomas Winklere1623442009-01-27 14:27:56 -08001194 IWL_DEBUG_ISR(priv, "Alive interrupt\n");
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001195 priv->isr_stats.alive++;
1196 }
Zhu Yib481de92007-09-25 17:54:57 -07001197 }
1198#endif
1199 /* Safely ignore these bits for debug checks below */
Joonwoo Park25c03d82008-01-23 10:15:20 -08001200 inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
Zhu Yib481de92007-09-25 17:54:57 -07001201
Ben Cahill9fbab512007-11-29 11:09:47 +08001202 /* HW RF KILL switch toggled */
Zhu Yib481de92007-09-25 17:54:57 -07001203 if (inta & CSR_INT_BIT_RF_KILL) {
1204 int hw_rf_kill = 0;
Tomas Winkler3395f6e2008-03-25 16:33:37 -07001205 if (!(iwl_read32(priv, CSR_GP_CNTRL) &
Zhu Yib481de92007-09-25 17:54:57 -07001206 CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW))
1207 hw_rf_kill = 1;
1208
Reinette Chatre4c423a22009-07-17 09:30:26 -07001209 IWL_WARN(priv, "RF_KILL bit toggled to %s.\n",
Abhijeet Kolekarc3056062008-11-12 13:14:08 -08001210 hw_rf_kill ? "disable radio" : "enable radio");
Zhu Yib481de92007-09-25 17:54:57 -07001211
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001212 priv->isr_stats.rfkill++;
1213
Emmanuel Grumbacha9efa652008-06-30 17:23:25 +08001214 /* driver only loads ucode once setting the interface up.
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01001215 * the driver allows loading the ucode even if the radio
1216 * is killed. Hence update the killswitch state here. The
1217 * rfkill handler will care about restarting if needed.
Emmanuel Grumbacha9efa652008-06-30 17:23:25 +08001218 */
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01001219 if (!test_bit(STATUS_ALIVE, &priv->status)) {
1220 if (hw_rf_kill)
1221 set_bit(STATUS_RF_KILL_HW, &priv->status);
1222 else
1223 clear_bit(STATUS_RF_KILL_HW, &priv->status);
Johannes Berga60e77e2009-06-04 18:26:06 +02001224 wiphy_rfkill_set_hw_state(priv->hw->wiphy, hw_rf_kill);
Mohamed Abbasedb34222008-12-11 10:33:37 -08001225 }
Zhu Yib481de92007-09-25 17:54:57 -07001226
1227 handled |= CSR_INT_BIT_RF_KILL;
1228 }
1229
Ben Cahill9fbab512007-11-29 11:09:47 +08001230 /* Chip got too hot and stopped itself */
Zhu Yib481de92007-09-25 17:54:57 -07001231 if (inta & CSR_INT_BIT_CT_KILL) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08001232 IWL_ERR(priv, "Microcode CT kill error detected.\n");
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001233 priv->isr_stats.ctkill++;
Zhu Yib481de92007-09-25 17:54:57 -07001234 handled |= CSR_INT_BIT_CT_KILL;
1235 }
1236
1237 /* Error detected by uCode */
1238 if (inta & CSR_INT_BIT_SW_ERR) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08001239 IWL_ERR(priv, "Microcode SW error detected. "
1240 " Restarting 0x%X.\n", inta);
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001241 priv->isr_stats.sw++;
1242 priv->isr_stats.sw_err = inta;
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001243 iwl_irq_handle_error(priv);
Zhu Yib481de92007-09-25 17:54:57 -07001244 handled |= CSR_INT_BIT_SW_ERR;
1245 }
1246
Ben Cahillc2e61da2009-10-30 14:36:09 -07001247 /*
1248 * uCode wakes up after power-down sleep.
1249 * Tell device about any new tx or host commands enqueued,
1250 * and about any Rx buffers made available while asleep.
1251 */
Zhu Yib481de92007-09-25 17:54:57 -07001252 if (inta & CSR_INT_BIT_WAKEUP) {
Tomas Winklere1623442009-01-27 14:27:56 -08001253 IWL_DEBUG_ISR(priv, "Wakeup interrupt\n");
Tomas Winklera55360e2008-05-05 10:22:28 +08001254 iwl_rx_queue_update_write_ptr(priv, &priv->rxq);
Ben Cahillc2e61da2009-10-30 14:36:09 -07001255 for (i = 0; i < priv->hw_params.max_txq_num; i++)
1256 iwl_txq_update_write_ptr(priv, &priv->txq[i]);
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001257 priv->isr_stats.wakeup++;
Zhu Yib481de92007-09-25 17:54:57 -07001258 handled |= CSR_INT_BIT_WAKEUP;
1259 }
1260
1261 /* All uCode command responses, including Tx command responses,
1262 * Rx "responses" (frame-received notification), and other
1263 * notifications from uCode come through here*/
1264 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
Tomas Winklera55360e2008-05-05 10:22:28 +08001265 iwl_rx_handle(priv);
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001266 priv->isr_stats.rx++;
Zhu Yib481de92007-09-25 17:54:57 -07001267 handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
1268 }
1269
Ben Cahillc72cd192009-10-30 14:36:08 -07001270 /* This "Tx" DMA channel is used only for loading uCode */
Zhu Yib481de92007-09-25 17:54:57 -07001271 if (inta & CSR_INT_BIT_FH_TX) {
Ben Cahillc72cd192009-10-30 14:36:08 -07001272 IWL_DEBUG_ISR(priv, "uCode load interrupt\n");
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001273 priv->isr_stats.tx++;
Zhu Yib481de92007-09-25 17:54:57 -07001274 handled |= CSR_INT_BIT_FH_TX;
Ben Cahillc72cd192009-10-30 14:36:08 -07001275 /* Wake up uCode load routine, now that load is complete */
Ron Rindjunskydbb983b2008-05-15 13:54:12 +08001276 priv->ucode_write_complete = 1;
1277 wake_up_interruptible(&priv->wait_command_queue);
Zhu Yib481de92007-09-25 17:54:57 -07001278 }
1279
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001280 if (inta & ~handled) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08001281 IWL_ERR(priv, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001282 priv->isr_stats.unhandled++;
1283 }
Zhu Yib481de92007-09-25 17:54:57 -07001284
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001285 if (inta & ~(priv->inta_mask)) {
Winkler, Tomas39aadf82008-12-19 10:37:32 +08001286 IWL_WARN(priv, "Disabled INTA bits 0x%08x were pending\n",
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001287 inta & ~priv->inta_mask);
Winkler, Tomas39aadf82008-12-19 10:37:32 +08001288 IWL_WARN(priv, " with FH_INT = 0x%08x\n", inta_fh);
Zhu Yib481de92007-09-25 17:54:57 -07001289 }
1290
1291 /* Re-enable all interrupts */
Mohamed Abbas0359fac2008-03-28 16:21:08 -07001292 /* only Re-enable if diabled by irq */
1293 if (test_bit(STATUS_INT_ENABLED, &priv->status))
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001294 iwl_enable_interrupts(priv);
Zhu Yib481de92007-09-25 17:54:57 -07001295
Tomas Winkler0a6857e2008-03-12 16:58:49 -07001296#ifdef CONFIG_IWLWIFI_DEBUG
Reinette Chatre3d816c72009-08-07 15:41:37 -07001297 if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
Tomas Winkler3395f6e2008-03-25 16:33:37 -07001298 inta = iwl_read32(priv, CSR_INT);
1299 inta_mask = iwl_read32(priv, CSR_INT_MASK);
1300 inta_fh = iwl_read32(priv, CSR_FH_INT_STATUS);
Tomas Winklere1623442009-01-27 14:27:56 -08001301 IWL_DEBUG_ISR(priv, "End inta 0x%08x, enabled 0x%08x, fh 0x%08x, "
Zhu Yib481de92007-09-25 17:54:57 -07001302 "flags 0x%08lx\n", inta, inta_mask, inta_fh, flags);
1303 }
1304#endif
Zhu Yib481de92007-09-25 17:54:57 -07001305}
1306
Mohamed Abbasef850d72009-05-22 11:01:50 -07001307/* tasklet for iwlagn interrupt */
1308static void iwl_irq_tasklet(struct iwl_priv *priv)
1309{
1310 u32 inta = 0;
1311 u32 handled = 0;
1312 unsigned long flags;
Ben Cahill87569902009-11-06 14:53:01 -08001313 u32 i;
Mohamed Abbasef850d72009-05-22 11:01:50 -07001314#ifdef CONFIG_IWLWIFI_DEBUG
1315 u32 inta_mask;
1316#endif
1317
1318 spin_lock_irqsave(&priv->lock, flags);
1319
1320 /* Ack/clear/reset pending uCode interrupts.
1321 * Note: Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
1322 */
Shanyu Zhao48a6be62010-03-16 10:22:26 -07001323 /* There is a hardware bug in the interrupt mask function that some
1324 * interrupts (i.e. CSR_INT_BIT_SCD) can still be generated even if
1325 * they are disabled in the CSR_INT_MASK register. Furthermore the
1326 * ICT interrupt handling mechanism has another bug that might cause
1327 * these unmasked interrupts fail to be detected. We workaround the
1328 * hardware bugs here by ACKing all the possible interrupts so that
1329 * interrupt coalescing can still be achieved.
1330 */
David S. Miller4a35ecf2010-04-06 23:53:30 -07001331 iwl_write32(priv, CSR_INT, priv->_agn.inta | ~priv->inta_mask);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001332
Johannes Berga4c8b2a2010-01-21 06:25:54 -08001333 inta = priv->_agn.inta;
Mohamed Abbasef850d72009-05-22 11:01:50 -07001334
1335#ifdef CONFIG_IWLWIFI_DEBUG
Reinette Chatre3d816c72009-08-07 15:41:37 -07001336 if (iwl_get_debug_level(priv) & IWL_DL_ISR) {
Mohamed Abbasef850d72009-05-22 11:01:50 -07001337 /* just for debug */
1338 inta_mask = iwl_read32(priv, CSR_INT_MASK);
1339 IWL_DEBUG_ISR(priv, "inta 0x%08x, enabled 0x%08x\n ",
1340 inta, inta_mask);
1341 }
1342#endif
Zhu Yi2f301222009-10-09 17:19:45 +08001343
1344 spin_unlock_irqrestore(&priv->lock, flags);
1345
Johannes Berga4c8b2a2010-01-21 06:25:54 -08001346 /* saved interrupt in inta variable now we can reset priv->_agn.inta */
1347 priv->_agn.inta = 0;
Mohamed Abbasef850d72009-05-22 11:01:50 -07001348
1349 /* Now service all interrupt bits discovered above. */
1350 if (inta & CSR_INT_BIT_HW_ERR) {
Reinette Chatre58dba722009-07-17 09:30:25 -07001351 IWL_ERR(priv, "Hardware error detected. Restarting.\n");
Mohamed Abbasef850d72009-05-22 11:01:50 -07001352
1353 /* Tell the device to stop sending interrupts */
1354 iwl_disable_interrupts(priv);
1355
1356 priv->isr_stats.hw++;
1357 iwl_irq_handle_error(priv);
1358
1359 handled |= CSR_INT_BIT_HW_ERR;
1360
Mohamed Abbasef850d72009-05-22 11:01:50 -07001361 return;
1362 }
1363
1364#ifdef CONFIG_IWLWIFI_DEBUG
Reinette Chatre3d816c72009-08-07 15:41:37 -07001365 if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
Mohamed Abbasef850d72009-05-22 11:01:50 -07001366 /* NIC fires this, but we don't use it, redundant with WAKEUP */
1367 if (inta & CSR_INT_BIT_SCD) {
1368 IWL_DEBUG_ISR(priv, "Scheduler finished to transmit "
1369 "the frame/frames.\n");
1370 priv->isr_stats.sch++;
1371 }
1372
1373 /* Alive notification via Rx interrupt will do the real work */
1374 if (inta & CSR_INT_BIT_ALIVE) {
1375 IWL_DEBUG_ISR(priv, "Alive interrupt\n");
1376 priv->isr_stats.alive++;
1377 }
1378 }
1379#endif
1380 /* Safely ignore these bits for debug checks below */
1381 inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
1382
1383 /* HW RF KILL switch toggled */
1384 if (inta & CSR_INT_BIT_RF_KILL) {
1385 int hw_rf_kill = 0;
1386 if (!(iwl_read32(priv, CSR_GP_CNTRL) &
1387 CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW))
1388 hw_rf_kill = 1;
1389
Reinette Chatre4c423a22009-07-17 09:30:26 -07001390 IWL_WARN(priv, "RF_KILL bit toggled to %s.\n",
Mohamed Abbasef850d72009-05-22 11:01:50 -07001391 hw_rf_kill ? "disable radio" : "enable radio");
1392
1393 priv->isr_stats.rfkill++;
1394
1395 /* driver only loads ucode once setting the interface up.
1396 * the driver allows loading the ucode even if the radio
1397 * is killed. Hence update the killswitch state here. The
1398 * rfkill handler will care about restarting if needed.
1399 */
1400 if (!test_bit(STATUS_ALIVE, &priv->status)) {
1401 if (hw_rf_kill)
1402 set_bit(STATUS_RF_KILL_HW, &priv->status);
1403 else
1404 clear_bit(STATUS_RF_KILL_HW, &priv->status);
Johannes Berga60e77e2009-06-04 18:26:06 +02001405 wiphy_rfkill_set_hw_state(priv->hw->wiphy, hw_rf_kill);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001406 }
1407
1408 handled |= CSR_INT_BIT_RF_KILL;
1409 }
1410
1411 /* Chip got too hot and stopped itself */
1412 if (inta & CSR_INT_BIT_CT_KILL) {
1413 IWL_ERR(priv, "Microcode CT kill error detected.\n");
1414 priv->isr_stats.ctkill++;
1415 handled |= CSR_INT_BIT_CT_KILL;
1416 }
1417
1418 /* Error detected by uCode */
1419 if (inta & CSR_INT_BIT_SW_ERR) {
1420 IWL_ERR(priv, "Microcode SW error detected. "
1421 " Restarting 0x%X.\n", inta);
1422 priv->isr_stats.sw++;
1423 priv->isr_stats.sw_err = inta;
1424 iwl_irq_handle_error(priv);
1425 handled |= CSR_INT_BIT_SW_ERR;
1426 }
1427
1428 /* uCode wakes up after power-down sleep */
1429 if (inta & CSR_INT_BIT_WAKEUP) {
1430 IWL_DEBUG_ISR(priv, "Wakeup interrupt\n");
1431 iwl_rx_queue_update_write_ptr(priv, &priv->rxq);
Ben Cahill87569902009-11-06 14:53:01 -08001432 for (i = 0; i < priv->hw_params.max_txq_num; i++)
1433 iwl_txq_update_write_ptr(priv, &priv->txq[i]);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001434
1435 priv->isr_stats.wakeup++;
1436
1437 handled |= CSR_INT_BIT_WAKEUP;
1438 }
1439
1440 /* All uCode command responses, including Tx command responses,
1441 * Rx "responses" (frame-received notification), and other
1442 * notifications from uCode come through here*/
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001443 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
1444 CSR_INT_BIT_RX_PERIODIC)) {
Mohamed Abbasef850d72009-05-22 11:01:50 -07001445 IWL_DEBUG_ISR(priv, "Rx interrupt\n");
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001446 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
1447 handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
1448 iwl_write32(priv, CSR_FH_INT_STATUS,
1449 CSR49_FH_INT_RX_MASK);
1450 }
1451 if (inta & CSR_INT_BIT_RX_PERIODIC) {
1452 handled |= CSR_INT_BIT_RX_PERIODIC;
1453 iwl_write32(priv, CSR_INT, CSR_INT_BIT_RX_PERIODIC);
1454 }
1455 /* Sending RX interrupt require many steps to be done in the
1456 * the device:
1457 * 1- write interrupt to current index in ICT table.
1458 * 2- dma RX frame.
1459 * 3- update RX shared data to indicate last write index.
1460 * 4- send interrupt.
1461 * This could lead to RX race, driver could receive RX interrupt
Ben Cahill74ba67e2009-11-20 12:04:53 -08001462 * but the shared data changes does not reflect this;
1463 * periodic interrupt will detect any dangling Rx activity.
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001464 */
Ben Cahill74ba67e2009-11-20 12:04:53 -08001465
1466 /* Disable periodic interrupt; we use it as just a one-shot. */
1467 iwl_write8(priv, CSR_INT_PERIODIC_REG,
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001468 CSR_INT_PERIODIC_DIS);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001469 iwl_rx_handle(priv);
Ben Cahill74ba67e2009-11-20 12:04:53 -08001470
1471 /*
1472 * Enable periodic interrupt in 8 msec only if we received
1473 * real RX interrupt (instead of just periodic int), to catch
1474 * any dangling Rx interrupt. If it was just the periodic
1475 * interrupt, there was no dangling Rx activity, and no need
1476 * to extend the periodic interrupt; one-shot is enough.
1477 */
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001478 if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
Ben Cahill74ba67e2009-11-20 12:04:53 -08001479 iwl_write8(priv, CSR_INT_PERIODIC_REG,
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001480 CSR_INT_PERIODIC_ENA);
1481
Mohamed Abbasef850d72009-05-22 11:01:50 -07001482 priv->isr_stats.rx++;
Mohamed Abbasef850d72009-05-22 11:01:50 -07001483 }
1484
Ben Cahillc72cd192009-10-30 14:36:08 -07001485 /* This "Tx" DMA channel is used only for loading uCode */
Mohamed Abbasef850d72009-05-22 11:01:50 -07001486 if (inta & CSR_INT_BIT_FH_TX) {
1487 iwl_write32(priv, CSR_FH_INT_STATUS, CSR49_FH_INT_TX_MASK);
Ben Cahillc72cd192009-10-30 14:36:08 -07001488 IWL_DEBUG_ISR(priv, "uCode load interrupt\n");
Mohamed Abbasef850d72009-05-22 11:01:50 -07001489 priv->isr_stats.tx++;
1490 handled |= CSR_INT_BIT_FH_TX;
Ben Cahillc72cd192009-10-30 14:36:08 -07001491 /* Wake up uCode load routine, now that load is complete */
Mohamed Abbasef850d72009-05-22 11:01:50 -07001492 priv->ucode_write_complete = 1;
1493 wake_up_interruptible(&priv->wait_command_queue);
1494 }
1495
1496 if (inta & ~handled) {
1497 IWL_ERR(priv, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
1498 priv->isr_stats.unhandled++;
1499 }
1500
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001501 if (inta & ~(priv->inta_mask)) {
Mohamed Abbasef850d72009-05-22 11:01:50 -07001502 IWL_WARN(priv, "Disabled INTA bits 0x%08x were pending\n",
Mohamed Abbas40cefda2009-05-22 11:01:52 -07001503 inta & ~priv->inta_mask);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001504 }
1505
Mohamed Abbasef850d72009-05-22 11:01:50 -07001506 /* Re-enable all interrupts */
1507 /* only Re-enable if diabled by irq */
1508 if (test_bit(STATUS_INT_ENABLED, &priv->status))
1509 iwl_enable_interrupts(priv);
Mohamed Abbasef850d72009-05-22 11:01:50 -07001510}
1511
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001512/* the threshold ratio of actual_ack_cnt to expected_ack_cnt in percent */
1513#define ACK_CNT_RATIO (50)
1514#define BA_TIMEOUT_CNT (5)
1515#define BA_TIMEOUT_MAX (16)
1516
1517/**
1518 * iwl_good_ack_health - checks for ACK count ratios, BA timeout retries.
1519 *
1520 * When the ACK count ratio is 0 and aggregated BA timeout retries exceeding
1521 * the BA_TIMEOUT_MAX, reload firmware and bring system back to normal
1522 * operation state.
1523 */
1524bool iwl_good_ack_health(struct iwl_priv *priv,
1525 struct iwl_rx_packet *pkt)
1526{
1527 bool rc = true;
1528 int actual_ack_cnt_delta, expected_ack_cnt_delta;
1529 int ba_timeout_delta;
1530
1531 actual_ack_cnt_delta =
1532 le32_to_cpu(pkt->u.stats.tx.actual_ack_cnt) -
Wey-Yi Guyf3aebee2010-06-14 17:09:54 -07001533 le32_to_cpu(priv->_agn.statistics.tx.actual_ack_cnt);
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001534 expected_ack_cnt_delta =
1535 le32_to_cpu(pkt->u.stats.tx.expected_ack_cnt) -
Wey-Yi Guyf3aebee2010-06-14 17:09:54 -07001536 le32_to_cpu(priv->_agn.statistics.tx.expected_ack_cnt);
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001537 ba_timeout_delta =
1538 le32_to_cpu(pkt->u.stats.tx.agg.ba_timeout) -
Wey-Yi Guyf3aebee2010-06-14 17:09:54 -07001539 le32_to_cpu(priv->_agn.statistics.tx.agg.ba_timeout);
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001540 if ((priv->_agn.agg_tids_count > 0) &&
1541 (expected_ack_cnt_delta > 0) &&
1542 (((actual_ack_cnt_delta * 100) / expected_ack_cnt_delta)
1543 < ACK_CNT_RATIO) &&
1544 (ba_timeout_delta > BA_TIMEOUT_CNT)) {
1545 IWL_DEBUG_RADIO(priv, "actual_ack_cnt delta = %d,"
1546 " expected_ack_cnt = %d\n",
1547 actual_ack_cnt_delta, expected_ack_cnt_delta);
1548
Johannes Bergd73e4922010-05-06 12:18:41 -07001549#ifdef CONFIG_IWLWIFI_DEBUGFS
1550 /*
1551 * This is ifdef'ed on DEBUGFS because otherwise the
1552 * statistics aren't available. If DEBUGFS is set but
1553 * DEBUG is not, these will just compile out.
1554 */
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001555 IWL_DEBUG_RADIO(priv, "rx_detected_cnt delta = %d\n",
Wey-Yi Guyf3aebee2010-06-14 17:09:54 -07001556 priv->_agn.delta_statistics.tx.rx_detected_cnt);
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001557 IWL_DEBUG_RADIO(priv,
1558 "ack_or_ba_timeout_collision delta = %d\n",
Wey-Yi Guyf3aebee2010-06-14 17:09:54 -07001559 priv->_agn.delta_statistics.tx.
Wey-Yi Guy872c8dd2010-03-16 10:46:31 -07001560 ack_or_ba_timeout_collision);
1561#endif
1562 IWL_DEBUG_RADIO(priv, "agg ba_timeout delta = %d\n",
1563 ba_timeout_delta);
1564 if (!actual_ack_cnt_delta &&
1565 (ba_timeout_delta >= BA_TIMEOUT_MAX))
1566 rc = false;
1567 }
1568 return rc;
1569}
1570
Wey-Yi Guya83b9142009-04-08 11:39:32 -07001571
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07001572/*****************************************************************************
1573 *
1574 * sysfs attributes
1575 *
1576 *****************************************************************************/
1577
1578#ifdef CONFIG_IWLWIFI_DEBUG
1579
1580/*
1581 * The following adds a new attribute to the sysfs representation
1582 * of this device driver (i.e. a new file in /sys/class/net/wlan0/device/)
1583 * used for controlling the debug level.
1584 *
1585 * See the level definitions in iwl for details.
1586 *
1587 * The debug_level being managed using sysfs below is a per device debug
1588 * level that is used instead of the global debug level if it (the per
1589 * device debug level) is set.
1590 */
1591static ssize_t show_debug_level(struct device *d,
1592 struct device_attribute *attr, char *buf)
1593{
1594 struct iwl_priv *priv = dev_get_drvdata(d);
1595 return sprintf(buf, "0x%08X\n", iwl_get_debug_level(priv));
1596}
1597static ssize_t store_debug_level(struct device *d,
1598 struct device_attribute *attr,
1599 const char *buf, size_t count)
1600{
1601 struct iwl_priv *priv = dev_get_drvdata(d);
1602 unsigned long val;
1603 int ret;
1604
1605 ret = strict_strtoul(buf, 0, &val);
1606 if (ret)
1607 IWL_ERR(priv, "%s is not in hex or decimal form.\n", buf);
1608 else {
1609 priv->debug_level = val;
1610 if (iwl_alloc_traffic_mem(priv))
1611 IWL_ERR(priv,
1612 "Not enough memory to generate traffic log\n");
1613 }
1614 return strnlen(buf, count);
1615}
1616
1617static DEVICE_ATTR(debug_level, S_IWUSR | S_IRUGO,
1618 show_debug_level, store_debug_level);
1619
1620
1621#endif /* CONFIG_IWLWIFI_DEBUG */
1622
1623
1624static ssize_t show_temperature(struct device *d,
1625 struct device_attribute *attr, char *buf)
1626{
1627 struct iwl_priv *priv = dev_get_drvdata(d);
1628
1629 if (!iwl_is_alive(priv))
1630 return -EAGAIN;
1631
1632 return sprintf(buf, "%d\n", priv->temperature);
1633}
1634
1635static DEVICE_ATTR(temperature, S_IRUGO, show_temperature, NULL);
1636
1637static ssize_t show_tx_power(struct device *d,
1638 struct device_attribute *attr, char *buf)
1639{
1640 struct iwl_priv *priv = dev_get_drvdata(d);
1641
1642 if (!iwl_is_ready_rf(priv))
1643 return sprintf(buf, "off\n");
1644 else
1645 return sprintf(buf, "%d\n", priv->tx_power_user_lmt);
1646}
1647
1648static ssize_t store_tx_power(struct device *d,
1649 struct device_attribute *attr,
1650 const char *buf, size_t count)
1651{
1652 struct iwl_priv *priv = dev_get_drvdata(d);
1653 unsigned long val;
1654 int ret;
1655
1656 ret = strict_strtoul(buf, 10, &val);
1657 if (ret)
1658 IWL_INFO(priv, "%s is not in decimal form.\n", buf);
1659 else {
1660 ret = iwl_set_tx_power(priv, val, false);
1661 if (ret)
1662 IWL_ERR(priv, "failed setting tx power (0x%d).\n",
1663 ret);
1664 else
1665 ret = count;
1666 }
1667 return ret;
1668}
1669
1670static DEVICE_ATTR(tx_power, S_IWUSR | S_IRUGO, show_tx_power, store_tx_power);
1671
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07001672static struct attribute *iwl_sysfs_entries[] = {
1673 &dev_attr_temperature.attr,
1674 &dev_attr_tx_power.attr,
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07001675#ifdef CONFIG_IWLWIFI_DEBUG
1676 &dev_attr_debug_level.attr,
1677#endif
1678 NULL
1679};
1680
1681static struct attribute_group iwl_attribute_group = {
1682 .name = NULL, /* put in device directory */
1683 .attrs = iwl_sysfs_entries,
1684};
1685
Zhu Yib481de92007-09-25 17:54:57 -07001686/******************************************************************************
1687 *
1688 * uCode download functions
1689 *
1690 ******************************************************************************/
1691
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001692static void iwl_dealloc_ucode_pci(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07001693{
Tomas Winkler98c92212008-01-14 17:46:20 -08001694 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_code);
1695 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_data);
1696 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_data_backup);
1697 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init);
1698 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init_data);
1699 iwl_free_fw_desc(priv->pci_dev, &priv->ucode_boot);
Zhu Yib481de92007-09-25 17:54:57 -07001700}
1701
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07001702static void iwl_nic_start(struct iwl_priv *priv)
Ron Rindjunskyedcdf8b2008-05-15 13:53:55 +08001703{
1704 /* Remove all resets to allow NIC to operate */
1705 iwl_write32(priv, CSR_RESET, 0);
1706}
1707
Johannes Bergdd7a2502010-04-28 23:33:10 -07001708struct iwlagn_ucode_capabilities {
1709 u32 max_probe_length;
Wey-Yi Guy6a822d02010-07-13 17:13:15 -07001710 u32 standard_phy_calibration_size;
Johannes Bergdd7a2502010-04-28 23:33:10 -07001711};
Ron Rindjunskyedcdf8b2008-05-15 13:53:55 +08001712
Johannes Bergb08dfd02010-01-29 11:54:56 -08001713static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context);
Johannes Bergdd7a2502010-04-28 23:33:10 -07001714static int iwl_mac_setup_register(struct iwl_priv *priv,
1715 struct iwlagn_ucode_capabilities *capa);
Johannes Bergb08dfd02010-01-29 11:54:56 -08001716
Jay Sternberg39396082010-08-12 10:24:07 -07001717#define UCODE_EXPERIMENTAL_INDEX 100
1718#define UCODE_EXPERIMENTAL_TAG "exp"
1719
Johannes Bergb08dfd02010-01-29 11:54:56 -08001720static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
Zhu Yib481de92007-09-25 17:54:57 -07001721{
Reinette Chatrea0987a82008-12-02 12:14:06 -08001722 const char *name_pre = priv->cfg->fw_name_pre;
Jay Sternberg39396082010-08-12 10:24:07 -07001723 char tag[8];
Johannes Bergb08dfd02010-01-29 11:54:56 -08001724
Jay Sternberg39396082010-08-12 10:24:07 -07001725 if (first) {
1726#ifdef CONFIG_IWLWIFI_DEBUG_EXPERIMENTAL_UCODE
1727 priv->fw_index = UCODE_EXPERIMENTAL_INDEX;
1728 strcpy(tag, UCODE_EXPERIMENTAL_TAG);
1729 } else if (priv->fw_index == UCODE_EXPERIMENTAL_INDEX) {
1730#endif
Johannes Bergb08dfd02010-01-29 11:54:56 -08001731 priv->fw_index = priv->cfg->ucode_api_max;
Jay Sternberg39396082010-08-12 10:24:07 -07001732 sprintf(tag, "%d", priv->fw_index);
1733 } else {
Johannes Bergb08dfd02010-01-29 11:54:56 -08001734 priv->fw_index--;
Jay Sternberg39396082010-08-12 10:24:07 -07001735 sprintf(tag, "%d", priv->fw_index);
1736 }
Johannes Bergb08dfd02010-01-29 11:54:56 -08001737
1738 if (priv->fw_index < priv->cfg->ucode_api_min) {
1739 IWL_ERR(priv, "no suitable firmware found!\n");
1740 return -ENOENT;
1741 }
1742
Jay Sternberg39396082010-08-12 10:24:07 -07001743 sprintf(priv->firmware_name, "%s%s%s", name_pre, tag, ".ucode");
Johannes Bergb08dfd02010-01-29 11:54:56 -08001744
Jay Sternberg39396082010-08-12 10:24:07 -07001745 IWL_DEBUG_INFO(priv, "attempting to load firmware %s'%s'\n",
1746 (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
1747 ? "EXPERIMENTAL " : "",
Johannes Bergb08dfd02010-01-29 11:54:56 -08001748 priv->firmware_name);
1749
1750 return request_firmware_nowait(THIS_MODULE, 1, priv->firmware_name,
1751 &priv->pci_dev->dev, GFP_KERNEL, priv,
1752 iwl_ucode_callback);
1753}
1754
Johannes Berg0e9a44d2010-04-28 12:09:16 -07001755struct iwlagn_firmware_pieces {
1756 const void *inst, *data, *init, *init_data, *boot;
1757 size_t inst_size, data_size, init_size, init_data_size, boot_size;
1758
1759 u32 build;
Johannes Bergb2e640d2010-05-05 23:24:54 -07001760
1761 u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
1762 u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
Johannes Berg0e9a44d2010-04-28 12:09:16 -07001763};
1764
1765static int iwlagn_load_legacy_firmware(struct iwl_priv *priv,
1766 const struct firmware *ucode_raw,
1767 struct iwlagn_firmware_pieces *pieces)
1768{
1769 struct iwl_ucode_header *ucode = (void *)ucode_raw->data;
1770 u32 api_ver, hdr_size;
1771 const u8 *src;
1772
1773 priv->ucode_ver = le32_to_cpu(ucode->ver);
1774 api_ver = IWL_UCODE_API(priv->ucode_ver);
1775
1776 switch (api_ver) {
1777 default:
1778 /*
1779 * 4965 doesn't revision the firmware file format
1780 * along with the API version, it always uses v1
1781 * file format.
1782 */
1783 if ((priv->hw_rev & CSR_HW_REV_TYPE_MSK) !=
1784 CSR_HW_REV_TYPE_4965) {
1785 hdr_size = 28;
1786 if (ucode_raw->size < hdr_size) {
1787 IWL_ERR(priv, "File size too small!\n");
1788 return -EINVAL;
1789 }
1790 pieces->build = le32_to_cpu(ucode->u.v2.build);
1791 pieces->inst_size = le32_to_cpu(ucode->u.v2.inst_size);
1792 pieces->data_size = le32_to_cpu(ucode->u.v2.data_size);
1793 pieces->init_size = le32_to_cpu(ucode->u.v2.init_size);
1794 pieces->init_data_size = le32_to_cpu(ucode->u.v2.init_data_size);
1795 pieces->boot_size = le32_to_cpu(ucode->u.v2.boot_size);
1796 src = ucode->u.v2.data;
1797 break;
1798 }
1799 /* fall through for 4965 */
1800 case 0:
1801 case 1:
1802 case 2:
1803 hdr_size = 24;
1804 if (ucode_raw->size < hdr_size) {
1805 IWL_ERR(priv, "File size too small!\n");
1806 return -EINVAL;
1807 }
1808 pieces->build = 0;
1809 pieces->inst_size = le32_to_cpu(ucode->u.v1.inst_size);
1810 pieces->data_size = le32_to_cpu(ucode->u.v1.data_size);
1811 pieces->init_size = le32_to_cpu(ucode->u.v1.init_size);
1812 pieces->init_data_size = le32_to_cpu(ucode->u.v1.init_data_size);
1813 pieces->boot_size = le32_to_cpu(ucode->u.v1.boot_size);
1814 src = ucode->u.v1.data;
1815 break;
1816 }
1817
1818 /* Verify size of file vs. image size info in file's header */
1819 if (ucode_raw->size != hdr_size + pieces->inst_size +
1820 pieces->data_size + pieces->init_size +
1821 pieces->init_data_size + pieces->boot_size) {
1822
1823 IWL_ERR(priv,
1824 "uCode file size %d does not match expected size\n",
1825 (int)ucode_raw->size);
1826 return -EINVAL;
1827 }
1828
1829 pieces->inst = src;
1830 src += pieces->inst_size;
1831 pieces->data = src;
1832 src += pieces->data_size;
1833 pieces->init = src;
1834 src += pieces->init_size;
1835 pieces->init_data = src;
1836 src += pieces->init_data_size;
1837 pieces->boot = src;
1838 src += pieces->boot_size;
1839
1840 return 0;
1841}
1842
Johannes Bergdd7a2502010-04-28 23:33:10 -07001843static int iwlagn_wanted_ucode_alternative = 1;
1844
1845static int iwlagn_load_firmware(struct iwl_priv *priv,
1846 const struct firmware *ucode_raw,
1847 struct iwlagn_firmware_pieces *pieces,
1848 struct iwlagn_ucode_capabilities *capa)
1849{
1850 struct iwl_tlv_ucode_header *ucode = (void *)ucode_raw->data;
1851 struct iwl_ucode_tlv *tlv;
1852 size_t len = ucode_raw->size;
1853 const u8 *data;
1854 int wanted_alternative = iwlagn_wanted_ucode_alternative, tmp;
1855 u64 alternatives;
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001856 u32 tlv_len;
1857 enum iwl_ucode_tlv_type tlv_type;
1858 const u8 *tlv_data;
Johannes Bergdd7a2502010-04-28 23:33:10 -07001859
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001860 if (len < sizeof(*ucode)) {
1861 IWL_ERR(priv, "uCode has invalid length: %zd\n", len);
Johannes Bergdd7a2502010-04-28 23:33:10 -07001862 return -EINVAL;
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001863 }
Johannes Bergdd7a2502010-04-28 23:33:10 -07001864
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001865 if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
1866 IWL_ERR(priv, "invalid uCode magic: 0X%x\n",
1867 le32_to_cpu(ucode->magic));
Johannes Bergdd7a2502010-04-28 23:33:10 -07001868 return -EINVAL;
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001869 }
Johannes Bergdd7a2502010-04-28 23:33:10 -07001870
1871 /*
1872 * Check which alternatives are present, and "downgrade"
1873 * when the chosen alternative is not present, warning
1874 * the user when that happens. Some files may not have
1875 * any alternatives, so don't warn in that case.
1876 */
1877 alternatives = le64_to_cpu(ucode->alternatives);
1878 tmp = wanted_alternative;
1879 if (wanted_alternative > 63)
1880 wanted_alternative = 63;
1881 while (wanted_alternative && !(alternatives & BIT(wanted_alternative)))
1882 wanted_alternative--;
1883 if (wanted_alternative && wanted_alternative != tmp)
1884 IWL_WARN(priv,
1885 "uCode alternative %d not available, choosing %d\n",
1886 tmp, wanted_alternative);
1887
1888 priv->ucode_ver = le32_to_cpu(ucode->ver);
1889 pieces->build = le32_to_cpu(ucode->build);
1890 data = ucode->data;
1891
1892 len -= sizeof(*ucode);
1893
Johannes Berg704da532010-07-14 09:34:50 -07001894 while (len >= sizeof(*tlv)) {
Johannes Bergdd7a2502010-04-28 23:33:10 -07001895 u16 tlv_alt;
Johannes Bergdd7a2502010-04-28 23:33:10 -07001896
1897 len -= sizeof(*tlv);
1898 tlv = (void *)data;
1899
1900 tlv_len = le32_to_cpu(tlv->length);
1901 tlv_type = le16_to_cpu(tlv->type);
1902 tlv_alt = le16_to_cpu(tlv->alternative);
1903 tlv_data = tlv->data;
1904
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001905 if (len < tlv_len) {
1906 IWL_ERR(priv, "invalid TLV len: %zd/%u\n",
1907 len, tlv_len);
Johannes Bergdd7a2502010-04-28 23:33:10 -07001908 return -EINVAL;
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001909 }
Johannes Bergdd7a2502010-04-28 23:33:10 -07001910 len -= ALIGN(tlv_len, 4);
1911 data += sizeof(*tlv) + ALIGN(tlv_len, 4);
1912
1913 /*
1914 * Alternative 0 is always valid.
1915 *
1916 * Skip alternative TLVs that are not selected.
1917 */
1918 if (tlv_alt != 0 && tlv_alt != wanted_alternative)
1919 continue;
1920
1921 switch (tlv_type) {
1922 case IWL_UCODE_TLV_INST:
1923 pieces->inst = tlv_data;
1924 pieces->inst_size = tlv_len;
1925 break;
1926 case IWL_UCODE_TLV_DATA:
1927 pieces->data = tlv_data;
1928 pieces->data_size = tlv_len;
1929 break;
1930 case IWL_UCODE_TLV_INIT:
1931 pieces->init = tlv_data;
1932 pieces->init_size = tlv_len;
1933 break;
1934 case IWL_UCODE_TLV_INIT_DATA:
1935 pieces->init_data = tlv_data;
1936 pieces->init_data_size = tlv_len;
1937 break;
1938 case IWL_UCODE_TLV_BOOT:
1939 pieces->boot = tlv_data;
1940 pieces->boot_size = tlv_len;
1941 break;
1942 case IWL_UCODE_TLV_PROBE_MAX_LEN:
Johannes Berg704da532010-07-14 09:34:50 -07001943 if (tlv_len != sizeof(u32))
1944 goto invalid_tlv_len;
1945 capa->max_probe_length =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001946 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergdd7a2502010-04-28 23:33:10 -07001947 break;
Johannes Bergb2e640d2010-05-05 23:24:54 -07001948 case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
Johannes Berg704da532010-07-14 09:34:50 -07001949 if (tlv_len != sizeof(u32))
1950 goto invalid_tlv_len;
1951 pieces->init_evtlog_ptr =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001952 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001953 break;
1954 case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
Johannes Berg704da532010-07-14 09:34:50 -07001955 if (tlv_len != sizeof(u32))
1956 goto invalid_tlv_len;
1957 pieces->init_evtlog_size =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001958 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001959 break;
1960 case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
Johannes Berg704da532010-07-14 09:34:50 -07001961 if (tlv_len != sizeof(u32))
1962 goto invalid_tlv_len;
1963 pieces->init_errlog_ptr =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001964 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001965 break;
1966 case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
Johannes Berg704da532010-07-14 09:34:50 -07001967 if (tlv_len != sizeof(u32))
1968 goto invalid_tlv_len;
1969 pieces->inst_evtlog_ptr =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001970 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001971 break;
1972 case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
Johannes Berg704da532010-07-14 09:34:50 -07001973 if (tlv_len != sizeof(u32))
1974 goto invalid_tlv_len;
1975 pieces->inst_evtlog_size =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001976 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001977 break;
1978 case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
Johannes Berg704da532010-07-14 09:34:50 -07001979 if (tlv_len != sizeof(u32))
1980 goto invalid_tlv_len;
1981 pieces->inst_errlog_ptr =
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001982 le32_to_cpup((__le32 *)tlv_data);
Johannes Bergb2e640d2010-05-05 23:24:54 -07001983 break;
Wey-Yi Guyc8312fa2010-06-28 13:05:17 -07001984 case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
1985 if (tlv_len)
Johannes Berg704da532010-07-14 09:34:50 -07001986 goto invalid_tlv_len;
1987 priv->enhance_sensitivity_table = true;
Wey-Yi Guyc8312fa2010-06-28 13:05:17 -07001988 break;
Wey-Yi Guy6a822d02010-07-13 17:13:15 -07001989 case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
Johannes Berg704da532010-07-14 09:34:50 -07001990 if (tlv_len != sizeof(u32))
1991 goto invalid_tlv_len;
1992 capa->standard_phy_calibration_size =
Wey-Yi Guy6a822d02010-07-13 17:13:15 -07001993 le32_to_cpup((__le32 *)tlv_data);
1994 break;
Johannes Bergdd7a2502010-04-28 23:33:10 -07001995 default:
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07001996 IWL_WARN(priv, "unknown TLV: %d\n", tlv_type);
Johannes Bergdd7a2502010-04-28 23:33:10 -07001997 break;
1998 }
1999 }
2000
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07002001 if (len) {
2002 IWL_ERR(priv, "invalid TLV after parsing: %zd\n", len);
2003 iwl_print_hex_dump(priv, IWL_DL_FW, (u8 *)data, len);
Johannes Berg704da532010-07-14 09:34:50 -07002004 return -EINVAL;
Wey-Yi Guyad8d8332010-06-22 14:31:45 -07002005 }
Johannes Bergdd7a2502010-04-28 23:33:10 -07002006
Johannes Berg704da532010-07-14 09:34:50 -07002007 return 0;
2008
2009 invalid_tlv_len:
2010 IWL_ERR(priv, "TLV %d has invalid size: %u\n", tlv_type, tlv_len);
2011 iwl_print_hex_dump(priv, IWL_DL_FW, tlv_data, tlv_len);
2012
2013 return -EINVAL;
Johannes Bergdd7a2502010-04-28 23:33:10 -07002014}
2015
Johannes Bergb08dfd02010-01-29 11:54:56 -08002016/**
2017 * iwl_ucode_callback - callback when firmware was loaded
2018 *
2019 * If loaded successfully, copies the firmware into buffers
2020 * for the card to fetch (via DMA).
2021 */
2022static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context)
2023{
2024 struct iwl_priv *priv = context;
2025 struct iwl_ucode_header *ucode;
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002026 int err;
2027 struct iwlagn_firmware_pieces pieces;
Reinette Chatrea0987a82008-12-02 12:14:06 -08002028 const unsigned int api_max = priv->cfg->ucode_api_max;
2029 const unsigned int api_min = priv->cfg->ucode_api_min;
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002030 u32 api_ver;
Johannes Berg3e4de762010-04-28 12:09:12 -07002031 char buildstr[25];
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002032 u32 build;
Johannes Bergdd7a2502010-04-28 23:33:10 -07002033 struct iwlagn_ucode_capabilities ucode_capa = {
2034 .max_probe_length = 200,
Wey-Yi Guy6a822d02010-07-13 17:13:15 -07002035 .standard_phy_calibration_size =
2036 IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE,
Johannes Bergdd7a2502010-04-28 23:33:10 -07002037 };
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002038
2039 memset(&pieces, 0, sizeof(pieces));
Zhu Yib481de92007-09-25 17:54:57 -07002040
Johannes Bergb08dfd02010-01-29 11:54:56 -08002041 if (!ucode_raw) {
Jay Sternberg39396082010-08-12 10:24:07 -07002042 if (priv->fw_index <= priv->cfg->ucode_api_max)
2043 IWL_ERR(priv,
2044 "request for firmware file '%s' failed.\n",
2045 priv->firmware_name);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002046 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002047 }
2048
Johannes Bergb08dfd02010-01-29 11:54:56 -08002049 IWL_DEBUG_INFO(priv, "Loaded firmware file '%s' (%zd bytes).\n",
2050 priv->firmware_name, ucode_raw->size);
Zhu Yib481de92007-09-25 17:54:57 -07002051
Johannes Berg22adba22010-04-28 12:09:14 -07002052 /* Make sure that we got at least the API version number */
2053 if (ucode_raw->size < 4) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08002054 IWL_ERR(priv, "File size way too small!\n");
Johannes Bergb08dfd02010-01-29 11:54:56 -08002055 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002056 }
2057
2058 /* Data from ucode file: header followed by uCode images */
Jay Sternbergcc0f5552009-07-17 09:30:16 -07002059 ucode = (struct iwl_ucode_header *)ucode_raw->data;
Zhu Yib481de92007-09-25 17:54:57 -07002060
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002061 if (ucode->ver)
2062 err = iwlagn_load_legacy_firmware(priv, ucode_raw, &pieces);
2063 else
Johannes Bergdd7a2502010-04-28 23:33:10 -07002064 err = iwlagn_load_firmware(priv, ucode_raw, &pieces,
2065 &ucode_capa);
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002066
2067 if (err)
2068 goto try_again;
2069
Reinette Chatrea0987a82008-12-02 12:14:06 -08002070 api_ver = IWL_UCODE_API(priv->ucode_ver);
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002071 build = pieces.build;
Zhu Yib481de92007-09-25 17:54:57 -07002072
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002073 /*
2074 * api_ver should match the api version forming part of the
Reinette Chatrea0987a82008-12-02 12:14:06 -08002075 * firmware filename ... but we don't check for that and only rely
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002076 * on the API version read from firmware header from here on forward
2077 */
Reinette Chatrea0987a82008-12-02 12:14:06 -08002078 if (api_ver < api_min || api_ver > api_max) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08002079 IWL_ERR(priv, "Driver unable to support your firmware API. "
Reinette Chatrea0987a82008-12-02 12:14:06 -08002080 "Driver supports v%u, firmware is v%u.\n",
2081 api_max, api_ver);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002082 goto try_again;
Reinette Chatrea0987a82008-12-02 12:14:06 -08002083 }
Johannes Bergb08dfd02010-01-29 11:54:56 -08002084
Reinette Chatrea0987a82008-12-02 12:14:06 -08002085 if (api_ver != api_max)
Tomas Winkler978785a2008-12-19 10:37:31 +08002086 IWL_ERR(priv, "Firmware has old API version. Expected v%u, "
Reinette Chatrea0987a82008-12-02 12:14:06 -08002087 "got v%u. New firmware can be obtained "
2088 "from http://www.intellinuxwireless.org.\n",
2089 api_max, api_ver);
2090
Johannes Berg3e4de762010-04-28 12:09:12 -07002091 if (build)
Jay Sternberg39396082010-08-12 10:24:07 -07002092 sprintf(buildstr, " build %u%s", build,
2093 (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
2094 ? " (EXP)" : "");
Johannes Berg3e4de762010-04-28 12:09:12 -07002095 else
2096 buildstr[0] = '\0';
Reinette Chatrea0987a82008-12-02 12:14:06 -08002097
Johannes Berg3e4de762010-04-28 12:09:12 -07002098 IWL_INFO(priv, "loaded firmware version %u.%u.%u.%u%s\n",
Reinette Chatre5ebeb5a2009-10-30 14:36:04 -07002099 IWL_UCODE_MAJOR(priv->ucode_ver),
2100 IWL_UCODE_MINOR(priv->ucode_ver),
2101 IWL_UCODE_API(priv->ucode_ver),
Johannes Berg3e4de762010-04-28 12:09:12 -07002102 IWL_UCODE_SERIAL(priv->ucode_ver),
2103 buildstr);
Reinette Chatre5ebeb5a2009-10-30 14:36:04 -07002104
Johannes Berg3e4de762010-04-28 12:09:12 -07002105 snprintf(priv->hw->wiphy->fw_version,
2106 sizeof(priv->hw->wiphy->fw_version),
2107 "%u.%u.%u.%u%s",
2108 IWL_UCODE_MAJOR(priv->ucode_ver),
2109 IWL_UCODE_MINOR(priv->ucode_ver),
2110 IWL_UCODE_API(priv->ucode_ver),
2111 IWL_UCODE_SERIAL(priv->ucode_ver),
2112 buildstr);
Zhu Yib481de92007-09-25 17:54:57 -07002113
Johannes Bergb08dfd02010-01-29 11:54:56 -08002114 /*
2115 * For any of the failures below (before allocating pci memory)
2116 * we will try to load a version with a smaller API -- maybe the
2117 * user just got a corrupted version of the latest API.
2118 */
2119
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002120 IWL_DEBUG_INFO(priv, "f/w package hdr ucode version raw = 0x%x\n",
2121 priv->ucode_ver);
2122 IWL_DEBUG_INFO(priv, "f/w package hdr runtime inst size = %Zd\n",
2123 pieces.inst_size);
2124 IWL_DEBUG_INFO(priv, "f/w package hdr runtime data size = %Zd\n",
2125 pieces.data_size);
2126 IWL_DEBUG_INFO(priv, "f/w package hdr init inst size = %Zd\n",
2127 pieces.init_size);
2128 IWL_DEBUG_INFO(priv, "f/w package hdr init data size = %Zd\n",
2129 pieces.init_data_size);
2130 IWL_DEBUG_INFO(priv, "f/w package hdr boot inst size = %Zd\n",
2131 pieces.boot_size);
Zhu Yib481de92007-09-25 17:54:57 -07002132
2133 /* Verify that uCode images will fit in card's SRAM */
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002134 if (pieces.inst_size > priv->hw_params.max_inst_size) {
2135 IWL_ERR(priv, "uCode instr len %Zd too large to fit in\n",
2136 pieces.inst_size);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002137 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002138 }
2139
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002140 if (pieces.data_size > priv->hw_params.max_data_size) {
2141 IWL_ERR(priv, "uCode data len %Zd too large to fit in\n",
2142 pieces.data_size);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002143 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002144 }
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002145
2146 if (pieces.init_size > priv->hw_params.max_inst_size) {
2147 IWL_ERR(priv, "uCode init instr len %Zd too large to fit in\n",
2148 pieces.init_size);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002149 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002150 }
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002151
2152 if (pieces.init_data_size > priv->hw_params.max_data_size) {
2153 IWL_ERR(priv, "uCode init data len %Zd too large to fit in\n",
2154 pieces.init_data_size);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002155 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002156 }
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002157
2158 if (pieces.boot_size > priv->hw_params.max_bsm_size) {
2159 IWL_ERR(priv, "uCode boot instr len %Zd too large to fit in\n",
2160 pieces.boot_size);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002161 goto try_again;
Zhu Yib481de92007-09-25 17:54:57 -07002162 }
2163
2164 /* Allocate ucode buffers for card's bus-master loading ... */
2165
2166 /* Runtime instructions and 2 copies of data:
2167 * 1) unmodified from disk
2168 * 2) backup cache for save/restore during power-downs */
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002169 priv->ucode_code.len = pieces.inst_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002170 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_code);
Zhu Yib481de92007-09-25 17:54:57 -07002171
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002172 priv->ucode_data.len = pieces.data_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002173 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_data);
Zhu Yib481de92007-09-25 17:54:57 -07002174
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002175 priv->ucode_data_backup.len = pieces.data_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002176 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_data_backup);
Zhu Yib481de92007-09-25 17:54:57 -07002177
Zhu, Yi1f304e42009-01-23 13:45:22 -08002178 if (!priv->ucode_code.v_addr || !priv->ucode_data.v_addr ||
2179 !priv->ucode_data_backup.v_addr)
2180 goto err_pci_alloc;
2181
Zhu Yib481de92007-09-25 17:54:57 -07002182 /* Initialization instructions and data */
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002183 if (pieces.init_size && pieces.init_data_size) {
2184 priv->ucode_init.len = pieces.init_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002185 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init);
Zhu Yib481de92007-09-25 17:54:57 -07002186
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002187 priv->ucode_init_data.len = pieces.init_data_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002188 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init_data);
Tomas Winkler90e759d2007-11-29 11:09:41 +08002189
2190 if (!priv->ucode_init.v_addr || !priv->ucode_init_data.v_addr)
2191 goto err_pci_alloc;
2192 }
Zhu Yib481de92007-09-25 17:54:57 -07002193
2194 /* Bootstrap (instructions only, no data) */
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002195 if (pieces.boot_size) {
2196 priv->ucode_boot.len = pieces.boot_size;
Tomas Winkler98c92212008-01-14 17:46:20 -08002197 iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_boot);
Zhu Yib481de92007-09-25 17:54:57 -07002198
Tomas Winkler90e759d2007-11-29 11:09:41 +08002199 if (!priv->ucode_boot.v_addr)
2200 goto err_pci_alloc;
2201 }
Zhu Yib481de92007-09-25 17:54:57 -07002202
Johannes Bergb2e640d2010-05-05 23:24:54 -07002203 /* Now that we can no longer fail, copy information */
2204
2205 /*
2206 * The (size - 16) / 12 formula is based on the information recorded
2207 * for each event, which is of mode 1 (including timestamp) for all
2208 * new microcodes that include this information.
2209 */
2210 priv->_agn.init_evtlog_ptr = pieces.init_evtlog_ptr;
2211 if (pieces.init_evtlog_size)
2212 priv->_agn.init_evtlog_size = (pieces.init_evtlog_size - 16)/12;
2213 else
2214 priv->_agn.init_evtlog_size = priv->cfg->max_event_log_size;
2215 priv->_agn.init_errlog_ptr = pieces.init_errlog_ptr;
2216 priv->_agn.inst_evtlog_ptr = pieces.inst_evtlog_ptr;
2217 if (pieces.inst_evtlog_size)
2218 priv->_agn.inst_evtlog_size = (pieces.inst_evtlog_size - 16)/12;
2219 else
2220 priv->_agn.inst_evtlog_size = priv->cfg->max_event_log_size;
2221 priv->_agn.inst_errlog_ptr = pieces.inst_errlog_ptr;
2222
Zhu Yib481de92007-09-25 17:54:57 -07002223 /* Copy images into buffers for card's bus-master reads ... */
2224
2225 /* Runtime instructions (first block of data in file) */
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002226 IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode instr len %Zd\n",
2227 pieces.inst_size);
2228 memcpy(priv->ucode_code.v_addr, pieces.inst, pieces.inst_size);
Jay Sternbergcc0f5552009-07-17 09:30:16 -07002229
Tomas Winklere1623442009-01-27 14:27:56 -08002230 IWL_DEBUG_INFO(priv, "uCode instr buf vaddr = 0x%p, paddr = 0x%08x\n",
Zhu Yib481de92007-09-25 17:54:57 -07002231 priv->ucode_code.v_addr, (u32)priv->ucode_code.p_addr);
2232
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002233 /*
2234 * Runtime data
2235 * NOTE: Copy into backup buffer will be done in iwl_up()
2236 */
2237 IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode data len %Zd\n",
2238 pieces.data_size);
2239 memcpy(priv->ucode_data.v_addr, pieces.data, pieces.data_size);
2240 memcpy(priv->ucode_data_backup.v_addr, pieces.data, pieces.data_size);
Zhu Yib481de92007-09-25 17:54:57 -07002241
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002242 /* Initialization instructions */
2243 if (pieces.init_size) {
Tomas Winklere1623442009-01-27 14:27:56 -08002244 IWL_DEBUG_INFO(priv, "Copying (but not loading) init instr len %Zd\n",
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002245 pieces.init_size);
2246 memcpy(priv->ucode_init.v_addr, pieces.init, pieces.init_size);
Zhu Yib481de92007-09-25 17:54:57 -07002247 }
2248
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002249 /* Initialization data */
2250 if (pieces.init_data_size) {
Tomas Winklere1623442009-01-27 14:27:56 -08002251 IWL_DEBUG_INFO(priv, "Copying (but not loading) init data len %Zd\n",
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002252 pieces.init_data_size);
2253 memcpy(priv->ucode_init_data.v_addr, pieces.init_data,
2254 pieces.init_data_size);
Zhu Yib481de92007-09-25 17:54:57 -07002255 }
2256
Johannes Berg0e9a44d2010-04-28 12:09:16 -07002257 /* Bootstrap instructions */
2258 IWL_DEBUG_INFO(priv, "Copying (but not loading) boot instr len %Zd\n",
2259 pieces.boot_size);
2260 memcpy(priv->ucode_boot.v_addr, pieces.boot, pieces.boot_size);
Zhu Yib481de92007-09-25 17:54:57 -07002261
Wey-Yi Guy6a822d02010-07-13 17:13:15 -07002262 /*
2263 * figure out the offset of chain noise reset and gain commands
2264 * base on the size of standard phy calibration commands table size
2265 */
2266 if (ucode_capa.standard_phy_calibration_size >
2267 IWL_MAX_PHY_CALIBRATE_TBL_SIZE)
2268 ucode_capa.standard_phy_calibration_size =
2269 IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE;
2270
2271 priv->_agn.phy_calib_chain_noise_reset_cmd =
2272 ucode_capa.standard_phy_calibration_size;
2273 priv->_agn.phy_calib_chain_noise_gain_cmd =
2274 ucode_capa.standard_phy_calibration_size + 1;
2275
Johannes Bergb08dfd02010-01-29 11:54:56 -08002276 /**************************************************
2277 * This is still part of probe() in a sense...
2278 *
2279 * 9. Setup and register with mac80211 and debugfs
2280 **************************************************/
Johannes Bergdd7a2502010-04-28 23:33:10 -07002281 err = iwl_mac_setup_register(priv, &ucode_capa);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002282 if (err)
2283 goto out_unbind;
2284
2285 err = iwl_dbgfs_register(priv, DRV_NAME);
2286 if (err)
2287 IWL_ERR(priv, "failed to create debugfs files. Ignoring error: %d\n", err);
2288
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07002289 err = sysfs_create_group(&priv->pci_dev->dev.kobj,
2290 &iwl_attribute_group);
2291 if (err) {
2292 IWL_ERR(priv, "failed to create sysfs device attributes\n");
2293 goto out_unbind;
2294 }
2295
Zhu Yib481de92007-09-25 17:54:57 -07002296 /* We have our copies now, allow OS release its copies */
2297 release_firmware(ucode_raw);
Reinette Chatrea15707d2010-05-10 15:08:11 -07002298 complete(&priv->_agn.firmware_loading_complete);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002299 return;
2300
2301 try_again:
2302 /* try next, if any */
2303 if (iwl_request_firmware(priv, false))
2304 goto out_unbind;
2305 release_firmware(ucode_raw);
2306 return;
Zhu Yib481de92007-09-25 17:54:57 -07002307
2308 err_pci_alloc:
Winkler, Tomas15b16872008-12-19 10:37:33 +08002309 IWL_ERR(priv, "failed to allocate pci memory\n");
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002310 iwl_dealloc_ucode_pci(priv);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002311 out_unbind:
Reinette Chatrea15707d2010-05-10 15:08:11 -07002312 complete(&priv->_agn.firmware_loading_complete);
Johannes Bergb08dfd02010-01-29 11:54:56 -08002313 device_release_driver(&priv->pci_dev->dev);
Zhu Yib481de92007-09-25 17:54:57 -07002314 release_firmware(ucode_raw);
Zhu Yib481de92007-09-25 17:54:57 -07002315}
2316
Reinette Chatreb7a79402009-09-25 14:24:23 -07002317static const char *desc_lookup_text[] = {
2318 "OK",
2319 "FAIL",
2320 "BAD_PARAM",
2321 "BAD_CHECKSUM",
2322 "NMI_INTERRUPT_WDG",
2323 "SYSASSERT",
2324 "FATAL_ERROR",
2325 "BAD_COMMAND",
2326 "HW_ERROR_TUNE_LOCK",
2327 "HW_ERROR_TEMPERATURE",
2328 "ILLEGAL_CHAN_FREQ",
2329 "VCC_NOT_STABLE",
2330 "FH_ERROR",
2331 "NMI_INTERRUPT_HOST",
2332 "NMI_INTERRUPT_ACTION_PT",
2333 "NMI_INTERRUPT_UNKNOWN",
2334 "UCODE_VERSION_MISMATCH",
2335 "HW_ERROR_ABS_LOCK",
2336 "HW_ERROR_CAL_LOCK_FAIL",
2337 "NMI_INTERRUPT_INST_ACTION_PT",
2338 "NMI_INTERRUPT_DATA_ACTION_PT",
2339 "NMI_TRM_HW_ER",
2340 "NMI_INTERRUPT_TRM",
2341 "NMI_INTERRUPT_BREAK_POINT"
2342 "DEBUG_0",
2343 "DEBUG_1",
2344 "DEBUG_2",
2345 "DEBUG_3",
Reinette Chatreb7a79402009-09-25 14:24:23 -07002346};
2347
Jay Sternberg4b586452010-07-02 15:49:10 -07002348static struct { char *name; u8 num; } advanced_lookup[] = {
2349 { "NMI_INTERRUPT_WDG", 0x34 },
2350 { "SYSASSERT", 0x35 },
2351 { "UCODE_VERSION_MISMATCH", 0x37 },
2352 { "BAD_COMMAND", 0x38 },
2353 { "NMI_INTERRUPT_DATA_ACTION_PT", 0x3C },
2354 { "FATAL_ERROR", 0x3D },
2355 { "NMI_TRM_HW_ERR", 0x46 },
2356 { "NMI_INTERRUPT_TRM", 0x4C },
2357 { "NMI_INTERRUPT_BREAK_POINT", 0x54 },
2358 { "NMI_INTERRUPT_WDG_RXF_FULL", 0x5C },
2359 { "NMI_INTERRUPT_WDG_NO_RBD_RXF_FULL", 0x64 },
2360 { "NMI_INTERRUPT_HOST", 0x66 },
2361 { "NMI_INTERRUPT_ACTION_PT", 0x7C },
2362 { "NMI_INTERRUPT_UNKNOWN", 0x84 },
2363 { "NMI_INTERRUPT_INST_ACTION_PT", 0x86 },
2364 { "ADVANCED_SYSASSERT", 0 },
2365};
2366
2367static const char *desc_lookup(u32 num)
Reinette Chatreb7a79402009-09-25 14:24:23 -07002368{
Jay Sternberg4b586452010-07-02 15:49:10 -07002369 int i;
2370 int max = ARRAY_SIZE(desc_lookup_text);
Reinette Chatreb7a79402009-09-25 14:24:23 -07002371
Jay Sternberg4b586452010-07-02 15:49:10 -07002372 if (num < max)
2373 return desc_lookup_text[num];
Reinette Chatreb7a79402009-09-25 14:24:23 -07002374
Jay Sternberg4b586452010-07-02 15:49:10 -07002375 max = ARRAY_SIZE(advanced_lookup) - 1;
2376 for (i = 0; i < max; i++) {
2377 if (advanced_lookup[i].num == num)
2378 break;;
2379 }
2380 return advanced_lookup[i].name;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002381}
2382
2383#define ERROR_START_OFFSET (1 * sizeof(u32))
2384#define ERROR_ELEM_SIZE (7 * sizeof(u32))
2385
2386void iwl_dump_nic_error_log(struct iwl_priv *priv)
2387{
2388 u32 data2, line;
2389 u32 desc, time, count, base, data1;
2390 u32 blink1, blink2, ilink1, ilink2;
Wey-Yi Guy461ef382010-03-30 17:57:53 -07002391 u32 pc, hcmd;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002392
Johannes Bergb2e640d2010-05-05 23:24:54 -07002393 if (priv->ucode_type == UCODE_INIT) {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002394 base = le32_to_cpu(priv->card_alive_init.error_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002395 if (!base)
2396 base = priv->_agn.init_errlog_ptr;
2397 } else {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002398 base = le32_to_cpu(priv->card_alive.error_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002399 if (!base)
2400 base = priv->_agn.inst_errlog_ptr;
2401 }
Reinette Chatreb7a79402009-09-25 14:24:23 -07002402
2403 if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
Wey-Yi Guy212fb572009-12-02 12:53:00 -08002404 IWL_ERR(priv,
2405 "Not valid error log pointer 0x%08X for %s uCode\n",
2406 base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
Reinette Chatreb7a79402009-09-25 14:24:23 -07002407 return;
2408 }
2409
2410 count = iwl_read_targ_mem(priv, base);
2411
2412 if (ERROR_START_OFFSET <= count * ERROR_ELEM_SIZE) {
2413 IWL_ERR(priv, "Start IWL Error Log Dump:\n");
2414 IWL_ERR(priv, "Status: 0x%08lX, count: %d\n",
2415 priv->status, count);
2416 }
2417
2418 desc = iwl_read_targ_mem(priv, base + 1 * sizeof(u32));
Wey-Yi Guy461ef382010-03-30 17:57:53 -07002419 pc = iwl_read_targ_mem(priv, base + 2 * sizeof(u32));
Reinette Chatreb7a79402009-09-25 14:24:23 -07002420 blink1 = iwl_read_targ_mem(priv, base + 3 * sizeof(u32));
2421 blink2 = iwl_read_targ_mem(priv, base + 4 * sizeof(u32));
2422 ilink1 = iwl_read_targ_mem(priv, base + 5 * sizeof(u32));
2423 ilink2 = iwl_read_targ_mem(priv, base + 6 * sizeof(u32));
2424 data1 = iwl_read_targ_mem(priv, base + 7 * sizeof(u32));
2425 data2 = iwl_read_targ_mem(priv, base + 8 * sizeof(u32));
2426 line = iwl_read_targ_mem(priv, base + 9 * sizeof(u32));
2427 time = iwl_read_targ_mem(priv, base + 11 * sizeof(u32));
Wey-Yi Guy461ef382010-03-30 17:57:53 -07002428 hcmd = iwl_read_targ_mem(priv, base + 22 * sizeof(u32));
Reinette Chatreb7a79402009-09-25 14:24:23 -07002429
Johannes Bergbe1a71a2009-10-02 13:44:02 -07002430 trace_iwlwifi_dev_ucode_error(priv, desc, time, data1, data2, line,
2431 blink1, blink2, ilink1, ilink2);
2432
Jay Sternberg87563712010-06-14 14:40:40 -07002433 IWL_ERR(priv, "Desc Time "
Reinette Chatreb7a79402009-09-25 14:24:23 -07002434 "data1 data2 line\n");
Jay Sternberg87563712010-06-14 14:40:40 -07002435 IWL_ERR(priv, "%-28s (0x%04X) %010u 0x%08X 0x%08X %u\n",
Reinette Chatreb7a79402009-09-25 14:24:23 -07002436 desc_lookup(desc), desc, time, data1, data2, line);
Wey-Yi Guy461ef382010-03-30 17:57:53 -07002437 IWL_ERR(priv, "pc blink1 blink2 ilink1 ilink2 hcmd\n");
2438 IWL_ERR(priv, "0x%05X 0x%05X 0x%05X 0x%05X 0x%05X 0x%05X\n",
2439 pc, blink1, blink2, ilink1, ilink2, hcmd);
Reinette Chatreb7a79402009-09-25 14:24:23 -07002440}
2441
2442#define EVENT_START_OFFSET (4 * sizeof(u32))
2443
2444/**
2445 * iwl_print_event_log - Dump error event log to syslog
2446 *
2447 */
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002448static int iwl_print_event_log(struct iwl_priv *priv, u32 start_idx,
2449 u32 num_events, u32 mode,
2450 int pos, char **buf, size_t bufsz)
Reinette Chatreb7a79402009-09-25 14:24:23 -07002451{
2452 u32 i;
2453 u32 base; /* SRAM byte address of event log header */
2454 u32 event_size; /* 2 u32s, or 3 u32s if timestamp recorded */
2455 u32 ptr; /* SRAM byte address of log data */
2456 u32 ev, time, data; /* event log data */
Ben Cahille5854472009-11-06 14:52:58 -08002457 unsigned long reg_flags;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002458
2459 if (num_events == 0)
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002460 return pos;
Johannes Bergb2e640d2010-05-05 23:24:54 -07002461
2462 if (priv->ucode_type == UCODE_INIT) {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002463 base = le32_to_cpu(priv->card_alive_init.log_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002464 if (!base)
2465 base = priv->_agn.init_evtlog_ptr;
2466 } else {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002467 base = le32_to_cpu(priv->card_alive.log_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002468 if (!base)
2469 base = priv->_agn.inst_evtlog_ptr;
2470 }
Reinette Chatreb7a79402009-09-25 14:24:23 -07002471
2472 if (mode == 0)
2473 event_size = 2 * sizeof(u32);
2474 else
2475 event_size = 3 * sizeof(u32);
2476
2477 ptr = base + EVENT_START_OFFSET + (start_idx * event_size);
2478
Ben Cahille5854472009-11-06 14:52:58 -08002479 /* Make sure device is powered up for SRAM reads */
2480 spin_lock_irqsave(&priv->reg_lock, reg_flags);
2481 iwl_grab_nic_access(priv);
2482
2483 /* Set starting address; reads will auto-increment */
2484 _iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
2485 rmb();
2486
Reinette Chatreb7a79402009-09-25 14:24:23 -07002487 /* "time" is actually "data" for mode 0 (no timestamp).
2488 * place event id # at far right for easier visual parsing. */
2489 for (i = 0; i < num_events; i++) {
Ben Cahille5854472009-11-06 14:52:58 -08002490 ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
2491 time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
Reinette Chatreb7a79402009-09-25 14:24:23 -07002492 if (mode == 0) {
2493 /* data, ev */
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002494 if (bufsz) {
2495 pos += scnprintf(*buf + pos, bufsz - pos,
2496 "EVT_LOG:0x%08x:%04u\n",
2497 time, ev);
2498 } else {
2499 trace_iwlwifi_dev_ucode_event(priv, 0,
2500 time, ev);
2501 IWL_ERR(priv, "EVT_LOG:0x%08x:%04u\n",
2502 time, ev);
2503 }
Reinette Chatreb7a79402009-09-25 14:24:23 -07002504 } else {
Ben Cahille5854472009-11-06 14:52:58 -08002505 data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002506 if (bufsz) {
2507 pos += scnprintf(*buf + pos, bufsz - pos,
2508 "EVT_LOGT:%010u:0x%08x:%04u\n",
2509 time, data, ev);
2510 } else {
2511 IWL_ERR(priv, "EVT_LOGT:%010u:0x%08x:%04u\n",
Reinette Chatreb7a79402009-09-25 14:24:23 -07002512 time, data, ev);
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002513 trace_iwlwifi_dev_ucode_event(priv, time,
2514 data, ev);
2515 }
Reinette Chatreb7a79402009-09-25 14:24:23 -07002516 }
2517 }
Ben Cahille5854472009-11-06 14:52:58 -08002518
2519 /* Allow device to power down */
2520 iwl_release_nic_access(priv);
2521 spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002522 return pos;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002523}
2524
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002525/**
2526 * iwl_print_last_event_logs - Dump the newest # of event log to syslog
2527 */
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002528static int iwl_print_last_event_logs(struct iwl_priv *priv, u32 capacity,
2529 u32 num_wraps, u32 next_entry,
2530 u32 size, u32 mode,
2531 int pos, char **buf, size_t bufsz)
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002532{
2533 /*
2534 * display the newest DEFAULT_LOG_ENTRIES entries
2535 * i.e the entries just before the next ont that uCode would fill.
2536 */
2537 if (num_wraps) {
2538 if (next_entry < size) {
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002539 pos = iwl_print_event_log(priv,
2540 capacity - (size - next_entry),
2541 size - next_entry, mode,
2542 pos, buf, bufsz);
2543 pos = iwl_print_event_log(priv, 0,
2544 next_entry, mode,
2545 pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002546 } else
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002547 pos = iwl_print_event_log(priv, next_entry - size,
2548 size, mode, pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002549 } else {
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002550 if (next_entry < size) {
2551 pos = iwl_print_event_log(priv, 0, next_entry,
2552 mode, pos, buf, bufsz);
2553 } else {
2554 pos = iwl_print_event_log(priv, next_entry - size,
2555 size, mode, pos, buf, bufsz);
2556 }
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002557 }
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002558 return pos;
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002559}
2560
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002561#define DEFAULT_DUMP_EVENT_LOG_ENTRIES (20)
2562
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002563int iwl_dump_nic_event_log(struct iwl_priv *priv, bool full_log,
2564 char **buf, bool display)
Reinette Chatreb7a79402009-09-25 14:24:23 -07002565{
2566 u32 base; /* SRAM byte address of event log header */
2567 u32 capacity; /* event log capacity in # entries */
2568 u32 mode; /* 0 - no timestamp, 1 - timestamp recorded */
2569 u32 num_wraps; /* # times uCode wrapped to top of log */
2570 u32 next_entry; /* index of next entry to be written by uCode */
2571 u32 size; /* # entries that we'll print */
Johannes Bergb2e640d2010-05-05 23:24:54 -07002572 u32 logsize;
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002573 int pos = 0;
2574 size_t bufsz = 0;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002575
Johannes Bergb2e640d2010-05-05 23:24:54 -07002576 if (priv->ucode_type == UCODE_INIT) {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002577 base = le32_to_cpu(priv->card_alive_init.log_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002578 logsize = priv->_agn.init_evtlog_size;
2579 if (!base)
2580 base = priv->_agn.init_evtlog_ptr;
2581 } else {
Reinette Chatreb7a79402009-09-25 14:24:23 -07002582 base = le32_to_cpu(priv->card_alive.log_event_table_ptr);
Johannes Bergb2e640d2010-05-05 23:24:54 -07002583 logsize = priv->_agn.inst_evtlog_size;
2584 if (!base)
2585 base = priv->_agn.inst_evtlog_ptr;
2586 }
Reinette Chatreb7a79402009-09-25 14:24:23 -07002587
2588 if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
Wey-Yi Guy212fb572009-12-02 12:53:00 -08002589 IWL_ERR(priv,
2590 "Invalid event log pointer 0x%08X for %s uCode\n",
2591 base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
Wey-Yi Guy937c3972010-01-15 13:43:36 -08002592 return -EINVAL;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002593 }
2594
2595 /* event log header */
2596 capacity = iwl_read_targ_mem(priv, base);
2597 mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
2598 num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
2599 next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));
2600
Johannes Bergb2e640d2010-05-05 23:24:54 -07002601 if (capacity > logsize) {
Ben Cahill84c40692009-11-06 14:52:57 -08002602 IWL_ERR(priv, "Log capacity %d is bogus, limit to %d entries\n",
Johannes Bergb2e640d2010-05-05 23:24:54 -07002603 capacity, logsize);
2604 capacity = logsize;
Ben Cahill84c40692009-11-06 14:52:57 -08002605 }
2606
Johannes Bergb2e640d2010-05-05 23:24:54 -07002607 if (next_entry > logsize) {
Ben Cahill84c40692009-11-06 14:52:57 -08002608 IWL_ERR(priv, "Log write index %d is bogus, limit to %d\n",
Johannes Bergb2e640d2010-05-05 23:24:54 -07002609 next_entry, logsize);
2610 next_entry = logsize;
Ben Cahill84c40692009-11-06 14:52:57 -08002611 }
2612
Reinette Chatreb7a79402009-09-25 14:24:23 -07002613 size = num_wraps ? capacity : next_entry;
2614
2615 /* bail out if nothing in log */
2616 if (size == 0) {
2617 IWL_ERR(priv, "Start IWL Event Log Dump: nothing in log\n");
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002618 return pos;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002619 }
2620
Wey-Yi Guyf37837c2010-08-23 07:57:12 -07002621 /* enable/disable bt channel announcement */
2622 priv->bt_ch_announce = iwlagn_bt_ch_announce;
2623
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002624#ifdef CONFIG_IWLWIFI_DEBUG
Wey-Yi Guy521d9bc2009-12-10 14:37:23 -08002625 if (!(iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) && !full_log)
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002626 size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
2627 ? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
2628#else
2629 size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
2630 ? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
Reinette Chatreb7a79402009-09-25 14:24:23 -07002631#endif
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002632 IWL_ERR(priv, "Start IWL Event Log Dump: display last %u entries\n",
2633 size);
2634
2635#ifdef CONFIG_IWLWIFI_DEBUG
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002636 if (display) {
2637 if (full_log)
2638 bufsz = capacity * 48;
2639 else
2640 bufsz = size * 48;
2641 *buf = kmalloc(bufsz, GFP_KERNEL);
2642 if (!*buf)
Wey-Yi Guy937c3972010-01-15 13:43:36 -08002643 return -ENOMEM;
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002644 }
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002645 if ((iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) || full_log) {
2646 /*
2647 * if uCode has wrapped back to top of log,
2648 * start at the oldest entry,
2649 * i.e the next one that uCode would fill.
2650 */
2651 if (num_wraps)
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002652 pos = iwl_print_event_log(priv, next_entry,
2653 capacity - next_entry, mode,
2654 pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002655 /* (then/else) start at top of log */
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002656 pos = iwl_print_event_log(priv, 0,
2657 next_entry, mode, pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002658 } else
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002659 pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
2660 next_entry, size, mode,
2661 pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002662#else
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002663 pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
2664 next_entry, size, mode,
2665 pos, buf, bufsz);
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002666#endif
Wey-Yi Guyb03d7d02009-12-14 14:12:20 -08002667 return pos;
Wey-Yi Guyc341ddb2009-11-20 12:05:07 -08002668}
Reinette Chatreb7a79402009-09-25 14:24:23 -07002669
Wey-Yi Guy0975cc82010-07-31 08:34:07 -07002670static void iwl_rf_kill_ct_config(struct iwl_priv *priv)
2671{
2672 struct iwl_ct_kill_config cmd;
2673 struct iwl_ct_kill_throttling_config adv_cmd;
2674 unsigned long flags;
2675 int ret = 0;
2676
2677 spin_lock_irqsave(&priv->lock, flags);
2678 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
2679 CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT);
2680 spin_unlock_irqrestore(&priv->lock, flags);
2681 priv->thermal_throttle.ct_kill_toggle = false;
2682
2683 if (priv->cfg->support_ct_kill_exit) {
2684 adv_cmd.critical_temperature_enter =
2685 cpu_to_le32(priv->hw_params.ct_kill_threshold);
2686 adv_cmd.critical_temperature_exit =
2687 cpu_to_le32(priv->hw_params.ct_kill_exit_threshold);
2688
2689 ret = iwl_send_cmd_pdu(priv, REPLY_CT_KILL_CONFIG_CMD,
2690 sizeof(adv_cmd), &adv_cmd);
2691 if (ret)
2692 IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
2693 else
2694 IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
2695 "succeeded, "
2696 "critical temperature enter is %d,"
2697 "exit is %d\n",
2698 priv->hw_params.ct_kill_threshold,
2699 priv->hw_params.ct_kill_exit_threshold);
2700 } else {
2701 cmd.critical_temperature_R =
2702 cpu_to_le32(priv->hw_params.ct_kill_threshold);
2703
2704 ret = iwl_send_cmd_pdu(priv, REPLY_CT_KILL_CONFIG_CMD,
2705 sizeof(cmd), &cmd);
2706 if (ret)
2707 IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
2708 else
2709 IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
2710 "succeeded, "
2711 "critical temperature is %d\n",
2712 priv->hw_params.ct_kill_threshold);
2713 }
2714}
2715
Zhu Yib481de92007-09-25 17:54:57 -07002716/**
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08002717 * iwl_alive_start - called after REPLY_ALIVE notification received
Zhu Yib481de92007-09-25 17:54:57 -07002718 * from protocol/runtime uCode (initialization uCode's
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08002719 * Alive gets handled by iwl_init_alive_start()).
Zhu Yib481de92007-09-25 17:54:57 -07002720 */
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08002721static void iwl_alive_start(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07002722{
Tomas Winkler57aab752008-04-14 21:16:03 -07002723 int ret = 0;
Johannes Berg246ed352010-08-23 10:46:32 +02002724 struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
Zhu Yib481de92007-09-25 17:54:57 -07002725
Tomas Winklere1623442009-01-27 14:27:56 -08002726 IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
Zhu Yib481de92007-09-25 17:54:57 -07002727
2728 if (priv->card_alive.is_valid != UCODE_VALID_OK) {
2729 /* We had an error bringing up the hardware, so take it
2730 * all the way back down so we can try again */
Tomas Winklere1623442009-01-27 14:27:56 -08002731 IWL_DEBUG_INFO(priv, "Alive failed.\n");
Zhu Yib481de92007-09-25 17:54:57 -07002732 goto restart;
2733 }
2734
2735 /* Initialize uCode has loaded Runtime uCode ... verify inst image.
2736 * This is a paranoid check, because we would not have gotten the
2737 * "runtime" alive if code weren't properly loaded. */
Emmanuel Grumbachb0692f22008-04-24 11:55:18 -07002738 if (iwl_verify_ucode(priv)) {
Zhu Yib481de92007-09-25 17:54:57 -07002739 /* Runtime instruction load was bad;
2740 * take it all the way back down so we can try again */
Tomas Winklere1623442009-01-27 14:27:56 -08002741 IWL_DEBUG_INFO(priv, "Bad runtime uCode load.\n");
Zhu Yib481de92007-09-25 17:54:57 -07002742 goto restart;
2743 }
2744
Tomas Winkler57aab752008-04-14 21:16:03 -07002745 ret = priv->cfg->ops->lib->alive_notify(priv);
2746 if (ret) {
Winkler, Tomas39aadf82008-12-19 10:37:32 +08002747 IWL_WARN(priv,
2748 "Could not complete ALIVE transition [ntf]: %d\n", ret);
Zhu Yib481de92007-09-25 17:54:57 -07002749 goto restart;
2750 }
2751
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002752 /* After the ALIVE response, we can send host commands to the uCode */
Zhu Yib481de92007-09-25 17:54:57 -07002753 set_bit(STATUS_ALIVE, &priv->status);
2754
Wey-Yi Guyb74e31a2010-03-01 17:23:50 -08002755 if (priv->cfg->ops->lib->recover_from_tx_stall) {
2756 /* Enable timer to monitor the driver queues */
2757 mod_timer(&priv->monitor_recover,
2758 jiffies +
2759 msecs_to_jiffies(priv->cfg->monitor_recover_period));
2760 }
2761
Tomas Winklerfee12472008-04-03 16:05:21 -07002762 if (iwl_is_rfkill(priv))
Zhu Yib481de92007-09-25 17:54:57 -07002763 return;
2764
Johannes Berg36d68252008-05-15 12:55:26 +02002765 ieee80211_wake_queues(priv->hw);
Zhu Yib481de92007-09-25 17:54:57 -07002766
Johannes Berg470ab2d2010-01-21 11:23:30 -08002767 priv->active_rate = IWL_RATES_MASK;
Zhu Yib481de92007-09-25 17:54:57 -07002768
Wey-Yi Guy2f748de2009-09-17 10:43:51 -07002769 /* Configure Tx antenna selection based on H/W config */
2770 if (priv->cfg->ops->hcmd->set_tx_ant)
2771 priv->cfg->ops->hcmd->set_tx_ant(priv, priv->cfg->valid_tx_ant);
2772
Johannes Berg246ed352010-08-23 10:46:32 +02002773 if (iwl_is_associated_ctx(ctx)) {
Gregory Greenmanc1adf9f2008-05-15 13:53:59 +08002774 struct iwl_rxon_cmd *active_rxon =
Johannes Berg246ed352010-08-23 10:46:32 +02002775 (struct iwl_rxon_cmd *)&ctx->active;
Mohamed Abbas019fb972009-03-17 21:59:18 -07002776 /* apply any changes in staging */
Johannes Berg246ed352010-08-23 10:46:32 +02002777 ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07002778 active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
2779 } else {
2780 /* Initialize our rx_config data */
Johannes Berg1dda6d22010-04-29 04:43:06 -07002781 iwl_connection_init_rx_config(priv, NULL);
Abhijeet Kolekar45823532009-04-08 11:26:44 -07002782
2783 if (priv->cfg->ops->hcmd->set_rxon_chain)
Johannes Berg246ed352010-08-23 10:46:32 +02002784 priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07002785 }
2786
Wey-Yi Guyaeb4a2e2010-08-23 07:57:05 -07002787 if (!priv->cfg->advanced_bt_coexist) {
2788 /* Configure Bluetooth device coexistence support */
2789 priv->cfg->ops->hcmd->send_bt_config(priv);
2790 }
Zhu Yib481de92007-09-25 17:54:57 -07002791
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08002792 iwl_reset_run_time_calib(priv);
2793
Zhu Yib481de92007-09-25 17:54:57 -07002794 /* Configure the adapter for unassociated operation */
Johannes Berg246ed352010-08-23 10:46:32 +02002795 iwlcore_commit_rxon(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07002796
2797 /* At this point, the NIC is initialized and operational */
Emmanuel Grumbach47f4a582008-06-12 09:47:13 +08002798 iwl_rf_kill_ct_config(priv);
Zhu Yi5a66926a2008-01-14 17:46:18 -08002799
Johannes Berge932a602009-10-02 13:44:03 -07002800 iwl_leds_init(priv);
Reinette Chatrefe00b5a2008-04-03 16:05:23 -07002801
Tomas Winklere1623442009-01-27 14:27:56 -08002802 IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
Rick Farringtona9f46782008-03-18 14:57:49 -07002803 set_bit(STATUS_READY, &priv->status);
Zhu Yi5a66926a2008-01-14 17:46:18 -08002804 wake_up_interruptible(&priv->wait_command_queue);
Zhu Yib481de92007-09-25 17:54:57 -07002805
Johannes Berge312c242009-08-07 15:41:51 -07002806 iwl_power_update_mode(priv, true);
Reinette Chatre7e246192010-02-18 22:58:32 -08002807 IWL_DEBUG_INFO(priv, "Updated power mode\n");
2808
Assaf Kraussc46fbef2008-06-12 09:47:05 +08002809
Zhu Yib481de92007-09-25 17:54:57 -07002810 return;
2811
2812 restart:
2813 queue_work(priv->workqueue, &priv->restart);
2814}
2815
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08002816static void iwl_cancel_deferred_work(struct iwl_priv *priv);
Zhu Yib481de92007-09-25 17:54:57 -07002817
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002818static void __iwl_down(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07002819{
2820 unsigned long flags;
2821 int exit_pending = test_bit(STATUS_EXIT_PENDING, &priv->status);
Zhu Yib481de92007-09-25 17:54:57 -07002822
Tomas Winklere1623442009-01-27 14:27:56 -08002823 IWL_DEBUG_INFO(priv, DRV_NAME " is going down\n");
Zhu Yib481de92007-09-25 17:54:57 -07002824
Zhu Yib481de92007-09-25 17:54:57 -07002825 if (!exit_pending)
2826 set_bit(STATUS_EXIT_PENDING, &priv->status);
2827
Stanislaw Gruszkab62177a2010-08-20 15:23:47 +02002828 /* Stop TX queues watchdog. We need to have STATUS_EXIT_PENDING bit set
2829 * to prevent rearm timer */
2830 if (priv->cfg->ops->lib->recover_from_tx_stall)
2831 del_timer_sync(&priv->monitor_recover);
2832
Johannes Bergdcef7322010-08-27 08:55:52 -07002833 iwl_clear_ucode_stations(priv, NULL);
Johannes Berga194e322010-08-27 08:53:46 -07002834 iwl_dealloc_bcast_stations(priv);
Johannes Bergdb125c72010-05-07 01:49:15 -07002835 iwl_clear_driver_stations(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002836
Johannes Berga1174132010-08-23 07:56:59 -07002837 /* reset BT coex data */
Wey-Yi Guyda5dbb92010-08-23 07:57:13 -07002838 priv->bt_status = 0;
Wey-Yi Guya4b96cc2010-08-23 07:57:08 -07002839 priv->bt_traffic_load = priv->cfg->bt_init_traffic_load;
Johannes Berga1174132010-08-23 07:56:59 -07002840 priv->bt_sco_active = false;
Wey-Yi Guybee008b2010-08-23 07:57:04 -07002841 priv->bt_full_concurrent = false;
2842 priv->bt_ci_compliance = 0;
Johannes Berga1174132010-08-23 07:56:59 -07002843
Zhu Yib481de92007-09-25 17:54:57 -07002844 /* Unblock any waiting calls */
2845 wake_up_interruptible_all(&priv->wait_command_queue);
2846
Zhu Yib481de92007-09-25 17:54:57 -07002847 /* Wipe out the EXIT_PENDING status bit if we are not actually
2848 * exiting the module */
2849 if (!exit_pending)
2850 clear_bit(STATUS_EXIT_PENDING, &priv->status);
2851
2852 /* stop and reset the on-board processor */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07002853 iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
Zhu Yib481de92007-09-25 17:54:57 -07002854
2855 /* tell the device to stop sending interrupts */
Mohamed Abbas0359fac2008-03-28 16:21:08 -07002856 spin_lock_irqsave(&priv->lock, flags);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002857 iwl_disable_interrupts(priv);
Mohamed Abbas0359fac2008-03-28 16:21:08 -07002858 spin_unlock_irqrestore(&priv->lock, flags);
2859 iwl_synchronize_irq(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002860
2861 if (priv->mac80211_registered)
2862 ieee80211_stop_queues(priv->hw);
2863
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002864 /* If we have not previously called iwl_init() then
Johannes Berga60e77e2009-06-04 18:26:06 +02002865 * clear all bits but the RF Kill bit and return */
Tomas Winklerfee12472008-04-03 16:05:21 -07002866 if (!iwl_is_init(priv)) {
Zhu Yib481de92007-09-25 17:54:57 -07002867 priv->status = test_bit(STATUS_RF_KILL_HW, &priv->status) <<
2868 STATUS_RF_KILL_HW |
Reinette Chatre97888642008-02-06 11:20:38 -08002869 test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
2870 STATUS_GEO_CONFIGURED |
Mohamed Abbas052ec3f2008-06-30 17:23:15 +08002871 test_bit(STATUS_EXIT_PENDING, &priv->status) <<
2872 STATUS_EXIT_PENDING;
Zhu Yib481de92007-09-25 17:54:57 -07002873 goto exit;
2874 }
2875
Wey-Yi Guy6da3a132009-03-26 10:14:08 -07002876 /* ...otherwise clear out all the status bits but the RF Kill
Johannes Berga60e77e2009-06-04 18:26:06 +02002877 * bit and continue taking the NIC down. */
Zhu Yib481de92007-09-25 17:54:57 -07002878 priv->status &= test_bit(STATUS_RF_KILL_HW, &priv->status) <<
2879 STATUS_RF_KILL_HW |
Reinette Chatre97888642008-02-06 11:20:38 -08002880 test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
2881 STATUS_GEO_CONFIGURED |
Zhu Yib481de92007-09-25 17:54:57 -07002882 test_bit(STATUS_FW_ERROR, &priv->status) <<
Mohamed Abbas052ec3f2008-06-30 17:23:15 +08002883 STATUS_FW_ERROR |
2884 test_bit(STATUS_EXIT_PENDING, &priv->status) <<
2885 STATUS_EXIT_PENDING;
Zhu Yib481de92007-09-25 17:54:57 -07002886
Mohamed Abbasef850d72009-05-22 11:01:50 -07002887 /* device going down, Stop using ICT table */
2888 iwl_disable_ict(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002889
Wey-Yi Guy74bcdb32010-03-17 13:34:34 -07002890 iwlagn_txq_ctx_stop(priv);
Wey-Yi Guy54b81552010-03-17 13:34:35 -07002891 iwlagn_rxq_stop(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002892
Ben Cahill309e7312009-11-06 14:53:03 -08002893 /* Power-down device's busmaster DMA clocks */
2894 iwl_write_prph(priv, APMG_CLK_DIS_REG, APMG_CLK_VAL_DMA_CLK_RQT);
Zhu Yib481de92007-09-25 17:54:57 -07002895 udelay(5);
2896
Ben Cahill309e7312009-11-06 14:53:03 -08002897 /* Make sure (redundant) we've released our request to stay awake */
2898 iwl_clear_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
2899
Ben Cahill4d2ccdb2009-10-09 13:20:20 -07002900 /* Stop the device, and put it in low power state */
2901 priv->cfg->ops->lib->apm_ops.stop(priv);
2902
Zhu Yib481de92007-09-25 17:54:57 -07002903 exit:
Tomas Winkler885ba202008-05-29 16:34:55 +08002904 memset(&priv->card_alive, 0, sizeof(struct iwl_alive_resp));
Zhu Yib481de92007-09-25 17:54:57 -07002905
2906 if (priv->ibss_beacon)
2907 dev_kfree_skb(priv->ibss_beacon);
2908 priv->ibss_beacon = NULL;
2909
2910 /* clear out any free frames */
Tomas Winklerfcab4232008-05-15 13:54:01 +08002911 iwl_clear_free_frames(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002912}
2913
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002914static void iwl_down(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07002915{
2916 mutex_lock(&priv->mutex);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002917 __iwl_down(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002918 mutex_unlock(&priv->mutex);
Zhu Yib24d22b2007-12-19 13:59:52 +08002919
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08002920 iwl_cancel_deferred_work(priv);
Zhu Yib481de92007-09-25 17:54:57 -07002921}
2922
Mohamed Abbas086ed112009-05-22 11:01:54 -07002923#define HW_READY_TIMEOUT (50)
2924
2925static int iwl_set_hw_ready(struct iwl_priv *priv)
2926{
2927 int ret = 0;
2928
2929 iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
2930 CSR_HW_IF_CONFIG_REG_BIT_NIC_READY);
2931
2932 /* See if we got it */
2933 ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
2934 CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
2935 CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
2936 HW_READY_TIMEOUT);
2937 if (ret != -ETIMEDOUT)
2938 priv->hw_ready = true;
2939 else
2940 priv->hw_ready = false;
2941
2942 IWL_DEBUG_INFO(priv, "hardware %s\n",
2943 (priv->hw_ready == 1) ? "ready" : "not ready");
2944 return ret;
2945}
2946
2947static int iwl_prepare_card_hw(struct iwl_priv *priv)
2948{
2949 int ret = 0;
2950
Frans Pop91dd6c22010-03-24 14:19:58 -07002951 IWL_DEBUG_INFO(priv, "iwl_prepare_card_hw enter\n");
Mohamed Abbas086ed112009-05-22 11:01:54 -07002952
Mohamed Abbas3354a0f2009-06-19 13:52:41 -07002953 ret = iwl_set_hw_ready(priv);
2954 if (priv->hw_ready)
2955 return ret;
2956
2957 /* If HW is not ready, prepare the conditions to check again */
Mohamed Abbas086ed112009-05-22 11:01:54 -07002958 iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
2959 CSR_HW_IF_CONFIG_REG_PREPARE);
2960
2961 ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
2962 ~CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE,
2963 CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE, 150000);
2964
Mohamed Abbas3354a0f2009-06-19 13:52:41 -07002965 /* HW should be ready by now, check again. */
Mohamed Abbas086ed112009-05-22 11:01:54 -07002966 if (ret != -ETIMEDOUT)
2967 iwl_set_hw_ready(priv);
2968
2969 return ret;
2970}
2971
Zhu Yib481de92007-09-25 17:54:57 -07002972#define MAX_HW_RESTARTS 5
2973
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07002974static int __iwl_up(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07002975{
Johannes Berga194e322010-08-27 08:53:46 -07002976 struct iwl_rxon_context *ctx;
Tomas Winkler57aab752008-04-14 21:16:03 -07002977 int i;
2978 int ret;
Zhu Yib481de92007-09-25 17:54:57 -07002979
2980 if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
Winkler, Tomas39aadf82008-12-19 10:37:32 +08002981 IWL_WARN(priv, "Exit pending; will not bring the NIC up\n");
Zhu Yib481de92007-09-25 17:54:57 -07002982 return -EIO;
2983 }
2984
Reinette Chatree903fbd2008-01-30 22:05:15 -08002985 if (!priv->ucode_data_backup.v_addr || !priv->ucode_data.v_addr) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08002986 IWL_ERR(priv, "ucode not available for device bringup\n");
Reinette Chatree903fbd2008-01-30 22:05:15 -08002987 return -EIO;
2988 }
2989
Johannes Berga194e322010-08-27 08:53:46 -07002990 for_each_context(priv, ctx) {
2991 ret = iwl_alloc_bcast_station(priv, ctx, true);
2992 if (ret) {
2993 iwl_dealloc_bcast_stations(priv);
2994 return ret;
2995 }
2996 }
Johannes Berg2c810cc2010-04-29 00:53:29 -07002997
Mohamed Abbas086ed112009-05-22 11:01:54 -07002998 iwl_prepare_card_hw(priv);
2999
3000 if (!priv->hw_ready) {
3001 IWL_WARN(priv, "Exit HW not ready\n");
3002 return -EIO;
3003 }
3004
Zhu Yie655b9f2008-01-24 02:19:38 -08003005 /* If platform's RF_KILL switch is NOT set to KILL */
Tomas Winklerc1842d62008-08-04 16:00:43 +08003006 if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
Zhu Yie655b9f2008-01-24 02:19:38 -08003007 clear_bit(STATUS_RF_KILL_HW, &priv->status);
Emmanuel Grumbach3bff19c2008-06-30 17:23:19 +08003008 else
Zhu Yie655b9f2008-01-24 02:19:38 -08003009 set_bit(STATUS_RF_KILL_HW, &priv->status);
Emmanuel Grumbach3bff19c2008-06-30 17:23:19 +08003010
Tomas Winklerc1842d62008-08-04 16:00:43 +08003011 if (iwl_is_rfkill(priv)) {
Johannes Berga60e77e2009-06-04 18:26:06 +02003012 wiphy_rfkill_set_hw_state(priv->hw->wiphy, true);
3013
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003014 iwl_enable_interrupts(priv);
Johannes Berga60e77e2009-06-04 18:26:06 +02003015 IWL_WARN(priv, "Radio disabled by HW RF Kill switch\n");
Tomas Winklerc1842d62008-08-04 16:00:43 +08003016 return 0;
Zhu Yib481de92007-09-25 17:54:57 -07003017 }
3018
Tomas Winkler3395f6e2008-03-25 16:33:37 -07003019 iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
Zhu Yib481de92007-09-25 17:54:57 -07003020
Johannes Berg13bb9482010-08-23 10:46:33 +02003021 /* must be initialised before iwl_hw_nic_init */
Johannes Berg751ca302010-08-23 10:46:34 +02003022 if (priv->valid_contexts != BIT(IWL_RXON_CTX_BSS))
3023 priv->cmd_queue = IWL_IPAN_CMD_QUEUE_NUM;
3024 else
3025 priv->cmd_queue = IWL_DEFAULT_CMD_QUEUE_NUM;
Johannes Berg13bb9482010-08-23 10:46:33 +02003026
Wey-Yi Guy74bcdb32010-03-17 13:34:34 -07003027 ret = iwlagn_hw_nic_init(priv);
Tomas Winkler57aab752008-04-14 21:16:03 -07003028 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08003029 IWL_ERR(priv, "Unable to init nic\n");
Tomas Winkler57aab752008-04-14 21:16:03 -07003030 return ret;
Zhu Yib481de92007-09-25 17:54:57 -07003031 }
3032
3033 /* make sure rfkill handshake bits are cleared */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07003034 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
3035 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
Zhu Yib481de92007-09-25 17:54:57 -07003036 CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
3037
3038 /* clear (again), then enable host interrupts */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07003039 iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003040 iwl_enable_interrupts(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003041
3042 /* really make sure rfkill handshake bits are cleared */
Tomas Winkler3395f6e2008-03-25 16:33:37 -07003043 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
3044 iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
Zhu Yib481de92007-09-25 17:54:57 -07003045
3046 /* Copy original ucode data image from disk into backup cache.
3047 * This will be used to initialize the on-board processor's
3048 * data SRAM for a clean start when the runtime program first loads. */
3049 memcpy(priv->ucode_data_backup.v_addr, priv->ucode_data.v_addr,
Zhu Yi5a66926a2008-01-14 17:46:18 -08003050 priv->ucode_data.len);
Zhu Yib481de92007-09-25 17:54:57 -07003051
Zhu Yib481de92007-09-25 17:54:57 -07003052 for (i = 0; i < MAX_HW_RESTARTS; i++) {
3053
Zhu Yib481de92007-09-25 17:54:57 -07003054 /* load bootstrap state machine,
3055 * load bootstrap program into processor's memory,
3056 * prepare to load the "initialize" uCode */
Tomas Winkler57aab752008-04-14 21:16:03 -07003057 ret = priv->cfg->ops->lib->load_ucode(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003058
Tomas Winkler57aab752008-04-14 21:16:03 -07003059 if (ret) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08003060 IWL_ERR(priv, "Unable to set up bootstrap uCode: %d\n",
3061 ret);
Zhu Yib481de92007-09-25 17:54:57 -07003062 continue;
3063 }
3064
3065 /* start card; "initialize" will load runtime ucode */
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003066 iwl_nic_start(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003067
Tomas Winklere1623442009-01-27 14:27:56 -08003068 IWL_DEBUG_INFO(priv, DRV_NAME " is coming up\n");
Zhu Yib481de92007-09-25 17:54:57 -07003069
3070 return 0;
3071 }
3072
3073 set_bit(STATUS_EXIT_PENDING, &priv->status);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003074 __iwl_down(priv);
Mohamed Abbas64e72c3e2008-06-12 09:47:03 +08003075 clear_bit(STATUS_EXIT_PENDING, &priv->status);
Zhu Yib481de92007-09-25 17:54:57 -07003076
3077 /* tried to restart and config the device for as long as our
3078 * patience could withstand */
Winkler, Tomas15b16872008-12-19 10:37:33 +08003079 IWL_ERR(priv, "Unable to initialize device after %d attempts.\n", i);
Zhu Yib481de92007-09-25 17:54:57 -07003080 return -EIO;
3081}
3082
3083
3084/*****************************************************************************
3085 *
3086 * Workqueue callbacks
3087 *
3088 *****************************************************************************/
3089
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08003090static void iwl_bg_init_alive_start(struct work_struct *data)
Zhu Yib481de92007-09-25 17:54:57 -07003091{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003092 struct iwl_priv *priv =
3093 container_of(data, struct iwl_priv, init_alive_start.work);
Zhu Yib481de92007-09-25 17:54:57 -07003094
3095 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3096 return;
3097
3098 mutex_lock(&priv->mutex);
Emmanuel Grumbachf3ccc082008-05-05 10:22:45 +08003099 priv->cfg->ops->lib->init_alive_start(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003100 mutex_unlock(&priv->mutex);
3101}
3102
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08003103static void iwl_bg_alive_start(struct work_struct *data)
Zhu Yib481de92007-09-25 17:54:57 -07003104{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003105 struct iwl_priv *priv =
3106 container_of(data, struct iwl_priv, alive_start.work);
Zhu Yib481de92007-09-25 17:54:57 -07003107
3108 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3109 return;
3110
Mohamed Abbas258c44a2009-06-03 11:44:10 -07003111 /* enable dram interrupt */
3112 iwl_reset_ict(priv);
3113
Zhu Yib481de92007-09-25 17:54:57 -07003114 mutex_lock(&priv->mutex);
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08003115 iwl_alive_start(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003116 mutex_unlock(&priv->mutex);
3117}
3118
Emmanuel Grumbach16e727e2008-06-12 09:46:52 +08003119static void iwl_bg_run_time_calib_work(struct work_struct *work)
3120{
3121 struct iwl_priv *priv = container_of(work, struct iwl_priv,
3122 run_time_calib_work);
3123
3124 mutex_lock(&priv->mutex);
3125
3126 if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
3127 test_bit(STATUS_SCANNING, &priv->status)) {
3128 mutex_unlock(&priv->mutex);
3129 return;
3130 }
3131
3132 if (priv->start_calib) {
Wey-Yi Guy7980fba2010-07-14 08:08:57 -07003133 if (priv->cfg->bt_statistics) {
3134 iwl_chain_noise_calibration(priv,
3135 (void *)&priv->_agn.statistics_bt);
3136 iwl_sensitivity_calibration(priv,
3137 (void *)&priv->_agn.statistics_bt);
3138 } else {
3139 iwl_chain_noise_calibration(priv,
3140 (void *)&priv->_agn.statistics);
3141 iwl_sensitivity_calibration(priv,
3142 (void *)&priv->_agn.statistics);
3143 }
Emmanuel Grumbach16e727e2008-06-12 09:46:52 +08003144 }
3145
3146 mutex_unlock(&priv->mutex);
Emmanuel Grumbach16e727e2008-06-12 09:46:52 +08003147}
3148
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003149static void iwl_bg_restart(struct work_struct *data)
Zhu Yib481de92007-09-25 17:54:57 -07003150{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003151 struct iwl_priv *priv = container_of(data, struct iwl_priv, restart);
Zhu Yib481de92007-09-25 17:54:57 -07003152
3153 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3154 return;
3155
Johannes Berg19cc1082009-05-08 13:44:36 -07003156 if (test_and_clear_bit(STATUS_FW_ERROR, &priv->status)) {
Wey-Yi Guybee008b2010-08-23 07:57:04 -07003157 bool bt_sco, bt_full_concurrent;
3158 u8 bt_ci_compliance;
Johannes Berg511b0822010-08-23 07:57:01 -07003159 u8 bt_load;
Wey-Yi Guyda5dbb92010-08-23 07:57:13 -07003160 u8 bt_status;
Johannes Berg511b0822010-08-23 07:57:01 -07003161
Johannes Berg19cc1082009-05-08 13:44:36 -07003162 mutex_lock(&priv->mutex);
3163 priv->vif = NULL;
3164 priv->is_open = 0;
Johannes Berg511b0822010-08-23 07:57:01 -07003165
3166 /*
3167 * __iwl_down() will clear the BT status variables,
3168 * which is correct, but when we restart we really
3169 * want to keep them so restore them afterwards.
3170 *
3171 * The restart process will later pick them up and
3172 * re-configure the hw when we reconfigure the BT
3173 * command.
3174 */
3175 bt_sco = priv->bt_sco_active;
Wey-Yi Guybee008b2010-08-23 07:57:04 -07003176 bt_full_concurrent = priv->bt_full_concurrent;
3177 bt_ci_compliance = priv->bt_ci_compliance;
Johannes Berg511b0822010-08-23 07:57:01 -07003178 bt_load = priv->bt_traffic_load;
Wey-Yi Guyda5dbb92010-08-23 07:57:13 -07003179 bt_status = priv->bt_status;
Johannes Berg511b0822010-08-23 07:57:01 -07003180
Johannes Berga1174132010-08-23 07:56:59 -07003181 __iwl_down(priv);
Johannes Berg511b0822010-08-23 07:57:01 -07003182
3183 priv->bt_sco_active = bt_sco;
Wey-Yi Guybee008b2010-08-23 07:57:04 -07003184 priv->bt_full_concurrent = bt_full_concurrent;
3185 priv->bt_ci_compliance = bt_ci_compliance;
Johannes Berg511b0822010-08-23 07:57:01 -07003186 priv->bt_traffic_load = bt_load;
Wey-Yi Guyda5dbb92010-08-23 07:57:13 -07003187 priv->bt_status = bt_status;
Johannes Berg511b0822010-08-23 07:57:01 -07003188
Johannes Berg19cc1082009-05-08 13:44:36 -07003189 mutex_unlock(&priv->mutex);
Johannes Berga1174132010-08-23 07:56:59 -07003190 iwl_cancel_deferred_work(priv);
Johannes Berg19cc1082009-05-08 13:44:36 -07003191 ieee80211_restart_hw(priv->hw);
3192 } else {
3193 iwl_down(priv);
Johannes Berg80676512010-01-21 06:07:17 -08003194
3195 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3196 return;
3197
3198 mutex_lock(&priv->mutex);
3199 __iwl_up(priv);
3200 mutex_unlock(&priv->mutex);
Johannes Berg19cc1082009-05-08 13:44:36 -07003201 }
Zhu Yib481de92007-09-25 17:54:57 -07003202}
3203
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003204static void iwl_bg_rx_replenish(struct work_struct *data)
Zhu Yib481de92007-09-25 17:54:57 -07003205{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003206 struct iwl_priv *priv =
3207 container_of(data, struct iwl_priv, rx_replenish);
Zhu Yib481de92007-09-25 17:54:57 -07003208
3209 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3210 return;
3211
3212 mutex_lock(&priv->mutex);
Wey-Yi Guy54b81552010-03-17 13:34:35 -07003213 iwlagn_rx_replenish(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003214 mutex_unlock(&priv->mutex);
3215}
3216
Mohamed Abbas7878a5a2007-11-29 11:10:13 +08003217#define IWL_DELAY_NEXT_SCAN (HZ*2)
3218
Johannes Berg1dda6d22010-04-29 04:43:06 -07003219void iwl_post_associate(struct iwl_priv *priv, struct ieee80211_vif *vif)
Zhu Yib481de92007-09-25 17:54:57 -07003220{
Johannes Berg246ed352010-08-23 10:46:32 +02003221 struct iwl_rxon_context *ctx;
Zhu Yib481de92007-09-25 17:54:57 -07003222 struct ieee80211_conf *conf = NULL;
Tomas Winkler857485c2008-03-21 13:53:44 -07003223 int ret = 0;
Zhu Yib481de92007-09-25 17:54:57 -07003224
Johannes Berg1dda6d22010-04-29 04:43:06 -07003225 if (!vif || !priv->is_open)
3226 return;
3227
Johannes Berg246ed352010-08-23 10:46:32 +02003228 ctx = iwl_rxon_ctx_from_vif(vif);
3229
Johannes Berg1dda6d22010-04-29 04:43:06 -07003230 if (vif->type == NL80211_IFTYPE_AP) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08003231 IWL_ERR(priv, "%s Should not be called in AP mode\n", __func__);
Zhu Yib481de92007-09-25 17:54:57 -07003232 return;
3233 }
3234
Zhu Yib481de92007-09-25 17:54:57 -07003235 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
3236 return;
3237
Tomas Winkler2a421b92008-06-12 09:47:10 +08003238 iwl_scan_cancel_timeout(priv, 200);
mabbas052c4b92007-10-25 17:15:43 +08003239
Zhu Yib481de92007-09-25 17:54:57 -07003240 conf = ieee80211_get_hw_conf(priv->hw);
3241
Johannes Berg246ed352010-08-23 10:46:32 +02003242 ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
3243 iwlcore_commit_rxon(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07003244
Johannes Berg948f5a22010-07-29 07:07:51 -07003245 ret = iwl_send_rxon_timing(priv, vif);
Tomas Winkler857485c2008-03-21 13:53:44 -07003246 if (ret)
Johannes Berg8f2d3d22010-08-23 10:46:37 +02003247 IWL_WARN(priv, "RXON timing - "
Zhu Yib481de92007-09-25 17:54:57 -07003248 "Attempting to continue.\n");
3249
Johannes Berg246ed352010-08-23 10:46:32 +02003250 ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003251
Emmanuel Grumbach42eb7c62008-09-17 10:10:05 +08003252 iwl_set_rxon_ht(priv, &priv->current_ht_config);
Ron Rindjunsky4f85f5b2008-06-09 22:54:35 +03003253
Abhijeet Kolekar45823532009-04-08 11:26:44 -07003254 if (priv->cfg->ops->hcmd->set_rxon_chain)
Johannes Berg246ed352010-08-23 10:46:32 +02003255 priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
Abhijeet Kolekar45823532009-04-08 11:26:44 -07003256
Johannes Berg246ed352010-08-23 10:46:32 +02003257 ctx->staging.assoc_id = cpu_to_le16(vif->bss_conf.aid);
Zhu Yib481de92007-09-25 17:54:57 -07003258
Tomas Winklere1623442009-01-27 14:27:56 -08003259 IWL_DEBUG_ASSOC(priv, "assoc id %d beacon interval %d\n",
Johannes Berg1dda6d22010-04-29 04:43:06 -07003260 vif->bss_conf.aid, vif->bss_conf.beacon_int);
Zhu Yib481de92007-09-25 17:54:57 -07003261
Johannes Bergc213d742010-05-06 12:21:40 -07003262 if (vif->bss_conf.use_short_preamble)
Johannes Berg246ed352010-08-23 10:46:32 +02003263 ctx->staging.flags |= RXON_FLG_SHORT_PREAMBLE_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003264 else
Johannes Berg246ed352010-08-23 10:46:32 +02003265 ctx->staging.flags &= ~RXON_FLG_SHORT_PREAMBLE_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003266
Johannes Berg246ed352010-08-23 10:46:32 +02003267 if (ctx->staging.flags & RXON_FLG_BAND_24G_MSK) {
Johannes Bergc213d742010-05-06 12:21:40 -07003268 if (vif->bss_conf.use_short_slot)
Johannes Berg246ed352010-08-23 10:46:32 +02003269 ctx->staging.flags |= RXON_FLG_SHORT_SLOT_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003270 else
Johannes Berg246ed352010-08-23 10:46:32 +02003271 ctx->staging.flags &= ~RXON_FLG_SHORT_SLOT_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003272 }
3273
Johannes Berg246ed352010-08-23 10:46:32 +02003274 iwlcore_commit_rxon(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07003275
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003276 IWL_DEBUG_ASSOC(priv, "Associated as %d to: %pM\n",
Johannes Berg246ed352010-08-23 10:46:32 +02003277 vif->bss_conf.aid, ctx->active.bssid_addr);
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003278
Johannes Berg1dda6d22010-04-29 04:43:06 -07003279 switch (vif->type) {
Johannes Berg05c914f2008-09-11 00:01:58 +02003280 case NL80211_IFTYPE_STATION:
Zhu Yib481de92007-09-25 17:54:57 -07003281 break;
Johannes Berg05c914f2008-09-11 00:01:58 +02003282 case NL80211_IFTYPE_ADHOC:
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003283 iwl_send_beacon_cmd(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003284 break;
Zhu Yib481de92007-09-25 17:54:57 -07003285 default:
Winkler, Tomas15b16872008-12-19 10:37:33 +08003286 IWL_ERR(priv, "%s Should not be called in %d mode\n",
Johannes Berg1dda6d22010-04-29 04:43:06 -07003287 __func__, vif->type);
Zhu Yib481de92007-09-25 17:54:57 -07003288 break;
3289 }
3290
Grumbach, Emmanuel04816442008-09-03 11:26:53 +08003291 /* the chain noise calibration will enabled PM upon completion
3292 * If chain noise has already been run, then we need to enable
3293 * power management here */
3294 if (priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE)
Johannes Berge312c242009-08-07 15:41:51 -07003295 iwl_power_update_mode(priv, false);
Emmanuel Grumbachc90a74ba2008-09-03 11:26:50 +08003296
3297 /* Enable Rx differential gain and sensitivity calibrations */
3298 iwl_chain_noise_reset(priv);
3299 priv->start_calib = 1;
3300
Reinette Chatre508e32e2008-04-14 21:16:13 -07003301}
3302
Zhu Yib481de92007-09-25 17:54:57 -07003303/*****************************************************************************
3304 *
3305 * mac80211 entry point functions
3306 *
3307 *****************************************************************************/
3308
Emmanuel Grumbach154b25c2008-06-30 17:23:24 +08003309#define UCODE_READY_TIMEOUT (4 * HZ)
Zhu Yi5a66926a2008-01-14 17:46:18 -08003310
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003311/*
3312 * Not a mac80211 entry point function, but it fits in with all the
3313 * other mac80211 functions grouped here.
3314 */
Johannes Bergdd7a2502010-04-28 23:33:10 -07003315static int iwl_mac_setup_register(struct iwl_priv *priv,
3316 struct iwlagn_ucode_capabilities *capa)
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003317{
3318 int ret;
3319 struct ieee80211_hw *hw = priv->hw;
3320 hw->rate_control_algorithm = "iwl-agn-rs";
3321
3322 /* Tell mac80211 our characteristics */
3323 hw->flags = IEEE80211_HW_SIGNAL_DBM |
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003324 IEEE80211_HW_AMPDU_AGGREGATION |
3325 IEEE80211_HW_SPECTRUM_MGMT;
3326
3327 if (!priv->cfg->broken_powersave)
3328 hw->flags |= IEEE80211_HW_SUPPORTS_PS |
3329 IEEE80211_HW_SUPPORTS_DYNAMIC_PS;
3330
Johannes Bergba37a3d2009-12-10 14:37:27 -08003331 if (priv->cfg->sku & IWL_SKU_N)
3332 hw->flags |= IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS |
3333 IEEE80211_HW_SUPPORTS_STATIC_SMPS;
3334
Reinette Chatre8d9698b2009-10-16 14:25:55 -07003335 hw->sta_data_size = sizeof(struct iwl_station_priv);
Johannes Bergfd1af152010-04-30 11:30:43 -07003336 hw->vif_data_size = sizeof(struct iwl_vif_priv);
3337
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003338 hw->wiphy->interface_modes =
3339 BIT(NL80211_IFTYPE_STATION) |
3340 BIT(NL80211_IFTYPE_ADHOC);
3341
Reinette Chatref6c8f152010-03-12 11:13:26 -08003342 hw->wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY |
Johannes Berg5be83de2009-11-19 00:56:28 +01003343 WIPHY_FLAG_DISABLE_BEACON_HINTS;
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003344
3345 /*
3346 * For now, disable PS by default because it affects
3347 * RX performance significantly.
3348 */
Johannes Berg5be83de2009-11-19 00:56:28 +01003349 hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003350
Reinette Chatre1382c712010-02-25 10:02:19 -08003351 hw->wiphy->max_scan_ssids = PROBE_OPTION_MAX;
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003352 /* we create the 802.11 header and a zero-length SSID element */
Johannes Bergdd7a2502010-04-28 23:33:10 -07003353 hw->wiphy->max_scan_ie_len = capa->max_probe_length - 24 - 2;
Reinette Chatref0b6e2e2009-10-16 14:25:53 -07003354
3355 /* Default value; 4 EDCA QOS priorities */
3356 hw->queues = 4;
3357
3358 hw->max_listen_interval = IWL_CONN_MAX_LISTEN_INTERVAL;
3359
3360 if (priv->bands[IEEE80211_BAND_2GHZ].n_channels)
3361 priv->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
3362 &priv->bands[IEEE80211_BAND_2GHZ];
3363 if (priv->bands[IEEE80211_BAND_5GHZ].n_channels)
3364 priv->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
3365 &priv->bands[IEEE80211_BAND_5GHZ];
3366
3367 ret = ieee80211_register_hw(priv->hw);
3368 if (ret) {
3369 IWL_ERR(priv, "Failed to register hw (error %d)\n", ret);
3370 return ret;
3371 }
3372 priv->mac80211_registered = 1;
3373
3374 return 0;
3375}
3376
3377
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003378static int iwl_mac_start(struct ieee80211_hw *hw)
Zhu Yib481de92007-09-25 17:54:57 -07003379{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003380 struct iwl_priv *priv = hw->priv;
Zhu Yi5a66926a2008-01-14 17:46:18 -08003381 int ret;
Zhu Yib481de92007-09-25 17:54:57 -07003382
Tomas Winklere1623442009-01-27 14:27:56 -08003383 IWL_DEBUG_MAC80211(priv, "enter\n");
Zhu Yib481de92007-09-25 17:54:57 -07003384
3385 /* we should be verifying the device is ready to be opened */
3386 mutex_lock(&priv->mutex);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003387 ret = __iwl_up(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003388 mutex_unlock(&priv->mutex);
Zhu Yi5a66926a2008-01-14 17:46:18 -08003389
Zhu Yie655b9f2008-01-24 02:19:38 -08003390 if (ret)
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01003391 return ret;
Zhu Yie655b9f2008-01-24 02:19:38 -08003392
Tomas Winklerc1842d62008-08-04 16:00:43 +08003393 if (iwl_is_rfkill(priv))
3394 goto out;
3395
Tomas Winklere1623442009-01-27 14:27:56 -08003396 IWL_DEBUG_INFO(priv, "Start UP work done.\n");
Zhu Yie655b9f2008-01-24 02:19:38 -08003397
Ron Rindjunskyfe9b6b72008-05-29 16:35:06 +08003398 /* Wait for START_ALIVE from Run Time ucode. Otherwise callbacks from
Zhu Yi5a66926a2008-01-14 17:46:18 -08003399 * mac80211 will not be run successfully. */
Emmanuel Grumbach154b25c2008-06-30 17:23:24 +08003400 ret = wait_event_interruptible_timeout(priv->wait_command_queue,
3401 test_bit(STATUS_READY, &priv->status),
3402 UCODE_READY_TIMEOUT);
3403 if (!ret) {
3404 if (!test_bit(STATUS_READY, &priv->status)) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08003405 IWL_ERR(priv, "START_ALIVE timeout after %dms.\n",
Emmanuel Grumbach154b25c2008-06-30 17:23:24 +08003406 jiffies_to_msecs(UCODE_READY_TIMEOUT));
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01003407 return -ETIMEDOUT;
Zhu Yi5a66926a2008-01-14 17:46:18 -08003408 }
Ron Rindjunskyfe9b6b72008-05-29 16:35:06 +08003409 }
Tomas Winkler0a078ff2008-06-30 17:23:26 +08003410
Johannes Berge932a602009-10-02 13:44:03 -07003411 iwl_led_start(priv);
3412
Tomas Winklerc1842d62008-08-04 16:00:43 +08003413out:
Tomas Winkler0a078ff2008-06-30 17:23:26 +08003414 priv->is_open = 1;
Tomas Winklere1623442009-01-27 14:27:56 -08003415 IWL_DEBUG_MAC80211(priv, "leave\n");
Zhu Yib481de92007-09-25 17:54:57 -07003416 return 0;
3417}
3418
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003419static void iwl_mac_stop(struct ieee80211_hw *hw)
Zhu Yib481de92007-09-25 17:54:57 -07003420{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003421 struct iwl_priv *priv = hw->priv;
Zhu Yib481de92007-09-25 17:54:57 -07003422
Tomas Winklere1623442009-01-27 14:27:56 -08003423 IWL_DEBUG_MAC80211(priv, "enter\n");
Mohamed Abbas948c1712007-10-25 17:15:45 +08003424
Johannes Berg19cc1082009-05-08 13:44:36 -07003425 if (!priv->is_open)
Zhu Yie655b9f2008-01-24 02:19:38 -08003426 return;
Zhu Yie655b9f2008-01-24 02:19:38 -08003427
Zhu Yib481de92007-09-25 17:54:57 -07003428 priv->is_open = 0;
Zhu Yi5a66926a2008-01-14 17:46:18 -08003429
Wey-Yi Guy5bddf542009-08-21 13:34:25 -07003430 if (iwl_is_ready_rf(priv) || test_bit(STATUS_SCAN_HW, &priv->status)) {
Zhu Yie655b9f2008-01-24 02:19:38 -08003431 /* stop mac, cancel any scan request and clear
3432 * RXON_FILTER_ASSOC_MSK BIT
3433 */
Zhu Yi5a66926a2008-01-14 17:46:18 -08003434 mutex_lock(&priv->mutex);
Tomas Winkler2a421b92008-06-12 09:47:10 +08003435 iwl_scan_cancel_timeout(priv, 100);
Mohamed Abbasfde35712007-11-29 11:10:15 +08003436 mutex_unlock(&priv->mutex);
Mohamed Abbasfde35712007-11-29 11:10:15 +08003437 }
3438
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003439 iwl_down(priv);
Zhu Yi5a66926a2008-01-14 17:46:18 -08003440
3441 flush_workqueue(priv->workqueue);
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01003442
3443 /* enable interrupts again in order to receive rfkill changes */
3444 iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
3445 iwl_enable_interrupts(priv);
Mohamed Abbas948c1712007-10-25 17:15:45 +08003446
Tomas Winklere1623442009-01-27 14:27:56 -08003447 IWL_DEBUG_MAC80211(priv, "leave\n");
Zhu Yib481de92007-09-25 17:54:57 -07003448}
3449
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003450static int iwl_mac_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
Zhu Yib481de92007-09-25 17:54:57 -07003451{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003452 struct iwl_priv *priv = hw->priv;
Zhu Yib481de92007-09-25 17:54:57 -07003453
Tomas Winklere1623442009-01-27 14:27:56 -08003454 IWL_DEBUG_MACDUMP(priv, "enter\n");
Zhu Yib481de92007-09-25 17:54:57 -07003455
Tomas Winklere1623442009-01-27 14:27:56 -08003456 IWL_DEBUG_TX(priv, "dev->xmit(%d bytes) at rate 0x%02x\n", skb->len,
Johannes Berge039fa42008-05-15 12:55:29 +02003457 ieee80211_get_tx_rate(hw, IEEE80211_SKB_CB(skb))->bitrate);
Zhu Yib481de92007-09-25 17:54:57 -07003458
Wey-Yi Guy74bcdb32010-03-17 13:34:34 -07003459 if (iwlagn_tx_skb(priv, skb))
Zhu Yib481de92007-09-25 17:54:57 -07003460 dev_kfree_skb_any(skb);
3461
Tomas Winklere1623442009-01-27 14:27:56 -08003462 IWL_DEBUG_MACDUMP(priv, "leave\n");
Reinette Chatre637f8832009-01-19 15:30:32 -08003463 return NETDEV_TX_OK;
Zhu Yib481de92007-09-25 17:54:57 -07003464}
3465
Johannes Berg1dda6d22010-04-29 04:43:06 -07003466void iwl_config_ap(struct iwl_priv *priv, struct ieee80211_vif *vif)
Zhu Yib481de92007-09-25 17:54:57 -07003467{
Johannes Berg246ed352010-08-23 10:46:32 +02003468 struct iwl_rxon_context *ctx = iwl_rxon_ctx_from_vif(vif);
Tomas Winkler857485c2008-03-21 13:53:44 -07003469 int ret = 0;
Zhu Yib481de92007-09-25 17:54:57 -07003470
Maarten Lankhorstd986bcd2008-01-23 10:15:16 -08003471 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
Zhu Yib481de92007-09-25 17:54:57 -07003472 return;
3473
3474 /* The following should be done only at AP bring up */
Johannes Berg246ed352010-08-23 10:46:32 +02003475 if (!iwl_is_associated_ctx(ctx)) {
Zhu Yib481de92007-09-25 17:54:57 -07003476
3477 /* RXON - unassoc (to set timing command) */
Johannes Berg246ed352010-08-23 10:46:32 +02003478 ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
3479 iwlcore_commit_rxon(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07003480
3481 /* RXON Timing */
Johannes Berg948f5a22010-07-29 07:07:51 -07003482 ret = iwl_send_rxon_timing(priv, vif);
Tomas Winkler857485c2008-03-21 13:53:44 -07003483 if (ret)
Johannes Berg8f2d3d22010-08-23 10:46:37 +02003484 IWL_WARN(priv, "RXON timing failed - "
Zhu Yib481de92007-09-25 17:54:57 -07003485 "Attempting to continue.\n");
3486
Daniel C Halperinf513dff2009-11-13 11:56:34 -08003487 /* AP has all antennas */
3488 priv->chain_noise_data.active_chains =
3489 priv->hw_params.valid_rx_ant;
3490 iwl_set_rxon_ht(priv, &priv->current_ht_config);
Abhijeet Kolekar45823532009-04-08 11:26:44 -07003491 if (priv->cfg->ops->hcmd->set_rxon_chain)
Johannes Berg246ed352010-08-23 10:46:32 +02003492 priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
Zhu Yib481de92007-09-25 17:54:57 -07003493
Johannes Berg246ed352010-08-23 10:46:32 +02003494 ctx->staging.assoc_id = 0;
Johannes Berg1dda6d22010-04-29 04:43:06 -07003495
Johannes Bergc213d742010-05-06 12:21:40 -07003496 if (vif->bss_conf.use_short_preamble)
Johannes Berg246ed352010-08-23 10:46:32 +02003497 ctx->staging.flags |=
Zhu Yib481de92007-09-25 17:54:57 -07003498 RXON_FLG_SHORT_PREAMBLE_MSK;
3499 else
Johannes Berg246ed352010-08-23 10:46:32 +02003500 ctx->staging.flags &=
Zhu Yib481de92007-09-25 17:54:57 -07003501 ~RXON_FLG_SHORT_PREAMBLE_MSK;
3502
Johannes Berg246ed352010-08-23 10:46:32 +02003503 if (ctx->staging.flags & RXON_FLG_BAND_24G_MSK) {
Johannes Bergc213d742010-05-06 12:21:40 -07003504 if (vif->bss_conf.use_short_slot)
Johannes Berg246ed352010-08-23 10:46:32 +02003505 ctx->staging.flags |=
Zhu Yib481de92007-09-25 17:54:57 -07003506 RXON_FLG_SHORT_SLOT_MSK;
3507 else
Johannes Berg246ed352010-08-23 10:46:32 +02003508 ctx->staging.flags &=
Zhu Yib481de92007-09-25 17:54:57 -07003509 ~RXON_FLG_SHORT_SLOT_MSK;
Zhu Yib481de92007-09-25 17:54:57 -07003510 }
3511 /* restore RXON assoc */
Johannes Berg246ed352010-08-23 10:46:32 +02003512 ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
3513 iwlcore_commit_rxon(priv, ctx);
Zhu Yie1493de2007-09-27 11:27:32 +08003514 }
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003515 iwl_send_beacon_cmd(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003516
3517 /* FIXME - we need to add code here to detect a totally new
3518 * configuration, reset the AP, unassoc, rxon timing, assoc,
3519 * clear sta table, add BCAST sta... */
3520}
3521
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003522static void iwl_mac_update_tkip_key(struct ieee80211_hw *hw,
Johannes Bergb3fbdcf2010-01-21 11:40:47 +01003523 struct ieee80211_vif *vif,
3524 struct ieee80211_key_conf *keyconf,
3525 struct ieee80211_sta *sta,
3526 u32 iv32, u16 *phase1key)
Emmanuel Grumbachab885f82008-03-20 15:06:43 +02003527{
Emmanuel Grumbachab885f82008-03-20 15:06:43 +02003528
Tomas Winkler9f586712008-11-12 13:14:05 -08003529 struct iwl_priv *priv = hw->priv;
Johannes Berga194e322010-08-27 08:53:46 -07003530 struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
3531
Tomas Winklere1623442009-01-27 14:27:56 -08003532 IWL_DEBUG_MAC80211(priv, "enter\n");
Emmanuel Grumbachab885f82008-03-20 15:06:43 +02003533
Johannes Berga194e322010-08-27 08:53:46 -07003534 iwl_update_tkip_key(priv, vif_priv->ctx, keyconf, sta,
Johannes Bergb3fbdcf2010-01-21 11:40:47 +01003535 iv32, phase1key);
Emmanuel Grumbachab885f82008-03-20 15:06:43 +02003536
Tomas Winklere1623442009-01-27 14:27:56 -08003537 IWL_DEBUG_MAC80211(priv, "leave\n");
Emmanuel Grumbachab885f82008-03-20 15:06:43 +02003538}
3539
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003540static int iwl_mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
Johannes Bergdc822b52008-12-29 12:55:09 +01003541 struct ieee80211_vif *vif,
3542 struct ieee80211_sta *sta,
Zhu Yib481de92007-09-25 17:54:57 -07003543 struct ieee80211_key_conf *key)
3544{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07003545 struct iwl_priv *priv = hw->priv;
Johannes Berga194e322010-08-27 08:53:46 -07003546 struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
Winkler, Tomas42986792009-01-19 15:30:22 -08003547 int ret;
3548 u8 sta_id;
3549 bool is_default_wep_key = false;
Zhu Yib481de92007-09-25 17:54:57 -07003550
Tomas Winklere1623442009-01-27 14:27:56 -08003551 IWL_DEBUG_MAC80211(priv, "enter\n");
Zhu Yib481de92007-09-25 17:54:57 -07003552
Tomas Winkler90e8e422009-06-19 13:52:42 -07003553 if (priv->cfg->mod_params->sw_crypto) {
Tomas Winklere1623442009-01-27 14:27:56 -08003554 IWL_DEBUG_MAC80211(priv, "leave - hwcrypto disabled\n");
Zhu Yib481de92007-09-25 17:54:57 -07003555 return -EOPNOTSUPP;
3556 }
Zhu Yib481de92007-09-25 17:54:57 -07003557
Johannes Berga194e322010-08-27 08:53:46 -07003558 sta_id = iwl_sta_id_or_broadcast(priv, vif_priv->ctx, sta);
Johannes Berg0af8bca2010-04-30 14:08:00 -07003559 if (sta_id == IWL_INVALID_STATION)
3560 return -EINVAL;
Zhu Yib481de92007-09-25 17:54:57 -07003561
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003562 mutex_lock(&priv->mutex);
Tomas Winkler2a421b92008-06-12 09:47:10 +08003563 iwl_scan_cancel_timeout(priv, 100);
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003564
Johannes Berga90178fa2010-03-30 02:44:16 -07003565 /*
3566 * If we are getting WEP group key and we didn't receive any key mapping
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003567 * so far, we are in legacy wep mode (group key only), otherwise we are
3568 * in 1X mode.
Johannes Berga90178fa2010-03-30 02:44:16 -07003569 * In legacy wep mode, we use another host command to the uCode.
3570 */
Johannes Berg97359d12010-08-10 09:46:38 +02003571 if ((key->cipher == WLAN_CIPHER_SUITE_WEP40 ||
3572 key->cipher == WLAN_CIPHER_SUITE_WEP104) &&
Johannes Berg54c80672010-08-18 09:35:21 -07003573 !sta) {
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003574 if (cmd == SET_KEY)
3575 is_default_wep_key = !priv->key_mapping_key;
3576 else
Emmanuel Grumbachccc038a2008-05-15 13:54:09 +08003577 is_default_wep_key =
3578 (key->hw_key_idx == HW_KEY_DEFAULT);
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003579 }
mabbas052c4b92007-10-25 17:15:43 +08003580
Zhu Yib481de92007-09-25 17:54:57 -07003581 switch (cmd) {
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003582 case SET_KEY:
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003583 if (is_default_wep_key)
3584 ret = iwl_set_default_wep_key(priv, key);
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003585 else
Johannes Berga194e322010-08-27 08:53:46 -07003586 ret = iwl_set_dynamic_key(priv, vif_priv->ctx,
3587 key, sta_id);
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003588
Tomas Winklere1623442009-01-27 14:27:56 -08003589 IWL_DEBUG_MAC80211(priv, "enable hwcrypto key\n");
Zhu Yib481de92007-09-25 17:54:57 -07003590 break;
3591 case DISABLE_KEY:
Emmanuel Grumbach6974e362008-04-14 21:16:06 -07003592 if (is_default_wep_key)
3593 ret = iwl_remove_default_wep_key(priv, key);
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003594 else
Emmanuel Grumbach3ec47732008-04-17 16:03:36 -07003595 ret = iwl_remove_dynamic_key(priv, key, sta_id);
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003596
Tomas Winklere1623442009-01-27 14:27:56 -08003597 IWL_DEBUG_MAC80211(priv, "disable hwcrypto key\n");
Zhu Yib481de92007-09-25 17:54:57 -07003598 break;
3599 default:
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003600 ret = -EINVAL;
Zhu Yib481de92007-09-25 17:54:57 -07003601 }
3602
Johannes Berg72e15d72010-02-19 11:42:32 -08003603 mutex_unlock(&priv->mutex);
Tomas Winklere1623442009-01-27 14:27:56 -08003604 IWL_DEBUG_MAC80211(priv, "leave\n");
Zhu Yib481de92007-09-25 17:54:57 -07003605
Emmanuel Grumbachdeb09c42008-03-19 16:41:41 -07003606 return ret;
Zhu Yib481de92007-09-25 17:54:57 -07003607}
3608
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003609static int iwl_mac_ampdu_action(struct ieee80211_hw *hw,
Johannes Bergc951ad32009-11-16 12:00:38 +01003610 struct ieee80211_vif *vif,
Johannes Berg832f47e2010-04-29 04:43:07 -07003611 enum ieee80211_ampdu_mlme_action action,
3612 struct ieee80211_sta *sta, u16 tid, u16 *ssn)
Tomas Winklerd783b062008-07-18 13:53:02 +08003613{
3614 struct iwl_priv *priv = hw->priv;
Johannes Berg4620fef2010-06-16 03:30:27 -07003615 int ret = -EINVAL;
Tomas Winklerd783b062008-07-18 13:53:02 +08003616
Tomas Winklere1623442009-01-27 14:27:56 -08003617 IWL_DEBUG_HT(priv, "A-MPDU action on addr %pM tid %d\n",
Johannes Berge1749612008-10-27 15:59:26 -07003618 sta->addr, tid);
Tomas Winklerd783b062008-07-18 13:53:02 +08003619
3620 if (!(priv->cfg->sku & IWL_SKU_N))
3621 return -EACCES;
3622
Johannes Berg4620fef2010-06-16 03:30:27 -07003623 mutex_lock(&priv->mutex);
3624
Tomas Winklerd783b062008-07-18 13:53:02 +08003625 switch (action) {
3626 case IEEE80211_AMPDU_RX_START:
Tomas Winklere1623442009-01-27 14:27:56 -08003627 IWL_DEBUG_HT(priv, "start Rx\n");
Johannes Berg4620fef2010-06-16 03:30:27 -07003628 ret = iwl_sta_rx_agg_start(priv, sta, tid, *ssn);
3629 break;
Tomas Winklerd783b062008-07-18 13:53:02 +08003630 case IEEE80211_AMPDU_RX_STOP:
Tomas Winklere1623442009-01-27 14:27:56 -08003631 IWL_DEBUG_HT(priv, "stop Rx\n");
Johannes Berg619753f2010-04-30 11:30:46 -07003632 ret = iwl_sta_rx_agg_stop(priv, sta, tid);
Wey-Yi Guy5c2207c2009-03-17 21:51:43 -07003633 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
Johannes Berg4620fef2010-06-16 03:30:27 -07003634 ret = 0;
3635 break;
Tomas Winklerd783b062008-07-18 13:53:02 +08003636 case IEEE80211_AMPDU_TX_START:
Tomas Winklere1623442009-01-27 14:27:56 -08003637 IWL_DEBUG_HT(priv, "start Tx\n");
Johannes Berg619753f2010-04-30 11:30:46 -07003638 ret = iwlagn_tx_agg_start(priv, vif, sta, tid, ssn);
Wey-Yi Guyd5a0ffa2010-03-04 13:38:59 -08003639 if (ret == 0) {
3640 priv->_agn.agg_tids_count++;
3641 IWL_DEBUG_HT(priv, "priv->_agn.agg_tids_count = %u\n",
3642 priv->_agn.agg_tids_count);
3643 }
Johannes Berg4620fef2010-06-16 03:30:27 -07003644 break;
Tomas Winklerd783b062008-07-18 13:53:02 +08003645 case IEEE80211_AMPDU_TX_STOP:
Tomas Winklere1623442009-01-27 14:27:56 -08003646 IWL_DEBUG_HT(priv, "stop Tx\n");
Johannes Berg619753f2010-04-30 11:30:46 -07003647 ret = iwlagn_tx_agg_stop(priv, vif, sta, tid);
Wey-Yi Guyd5a0ffa2010-03-04 13:38:59 -08003648 if ((ret == 0) && (priv->_agn.agg_tids_count > 0)) {
3649 priv->_agn.agg_tids_count--;
3650 IWL_DEBUG_HT(priv, "priv->_agn.agg_tids_count = %u\n",
3651 priv->_agn.agg_tids_count);
3652 }
Wey-Yi Guy5c2207c2009-03-17 21:51:43 -07003653 if (test_bit(STATUS_EXIT_PENDING, &priv->status))
Johannes Berg4620fef2010-06-16 03:30:27 -07003654 ret = 0;
Johannes Berg94597ab2010-08-09 10:57:02 -07003655 if (priv->cfg->use_rts_for_aggregation) {
3656 struct iwl_station_priv *sta_priv =
3657 (void *) sta->drv_priv;
3658 /*
3659 * switch off RTS/CTS if it was previously enabled
3660 */
3661
3662 sta_priv->lq_sta.lq.general_params.flags &=
3663 ~LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
3664 iwl_send_lq_cmd(priv, &sta_priv->lq_sta.lq,
3665 CMD_ASYNC, false);
3666 }
Johannes Berg4620fef2010-06-16 03:30:27 -07003667 break;
Wey-Yi Guyf0527972010-01-08 10:04:41 -08003668 case IEEE80211_AMPDU_TX_OPERATIONAL:
Johannes Berg94597ab2010-08-09 10:57:02 -07003669 if (priv->cfg->use_rts_for_aggregation) {
3670 struct iwl_station_priv *sta_priv =
3671 (void *) sta->drv_priv;
3672
Wey-Yi Guycfecc6b2010-06-18 11:33:15 -07003673 /*
3674 * switch to RTS/CTS if it is the prefer protection
3675 * method for HT traffic
3676 */
Johannes Berg94597ab2010-08-09 10:57:02 -07003677
3678 sta_priv->lq_sta.lq.general_params.flags |=
3679 LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
3680 iwl_send_lq_cmd(priv, &sta_priv->lq_sta.lq,
3681 CMD_ASYNC, false);
Wey-Yi Guycfecc6b2010-06-18 11:33:15 -07003682 }
3683 ret = 0;
Tomas Winklerd783b062008-07-18 13:53:02 +08003684 break;
3685 }
Johannes Berg4620fef2010-06-16 03:30:27 -07003686 mutex_unlock(&priv->mutex);
3687
3688 return ret;
Tomas Winklerd783b062008-07-18 13:53:02 +08003689}
Tomas Winkler9f586712008-11-12 13:14:05 -08003690
Johannes Berg6ab10ff2009-11-13 11:56:37 -08003691static void iwl_mac_sta_notify(struct ieee80211_hw *hw,
3692 struct ieee80211_vif *vif,
3693 enum sta_notify_cmd cmd,
3694 struct ieee80211_sta *sta)
3695{
3696 struct iwl_priv *priv = hw->priv;
3697 struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
3698 int sta_id;
3699
Johannes Berg6ab10ff2009-11-13 11:56:37 -08003700 switch (cmd) {
Johannes Berg6ab10ff2009-11-13 11:56:37 -08003701 case STA_NOTIFY_SLEEP:
3702 WARN_ON(!sta_priv->client);
3703 sta_priv->asleep = true;
3704 if (atomic_read(&sta_priv->pending_frames) > 0)
3705 ieee80211_sta_block_awake(hw, sta, true);
3706 break;
3707 case STA_NOTIFY_AWAKE:
3708 WARN_ON(!sta_priv->client);
Daniel Halperin49dcc812010-01-19 10:22:19 -08003709 if (!sta_priv->asleep)
3710 break;
Johannes Berg6ab10ff2009-11-13 11:56:37 -08003711 sta_priv->asleep = false;
Johannes Berg2a87c262010-04-30 11:30:45 -07003712 sta_id = iwl_sta_id(sta);
Johannes Berg6ab10ff2009-11-13 11:56:37 -08003713 if (sta_id != IWL_INVALID_STATION)
3714 iwl_sta_modify_ps_wake(priv, sta_id);
3715 break;
3716 default:
3717 break;
3718 }
3719}
3720
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003721static int iwlagn_mac_sta_add(struct ieee80211_hw *hw,
3722 struct ieee80211_vif *vif,
3723 struct ieee80211_sta *sta)
3724{
3725 struct iwl_priv *priv = hw->priv;
3726 struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
Johannes Berga194e322010-08-27 08:53:46 -07003727 struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
Johannes Bergeafdfbd32010-04-29 04:43:04 -07003728 bool is_ap = vif->type == NL80211_IFTYPE_STATION;
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003729 int ret;
3730 u8 sta_id;
3731
3732 IWL_DEBUG_INFO(priv, "received request to add station %pM\n",
3733 sta->addr);
Reinette Chatreda5ae1c2010-05-28 09:28:39 -07003734 mutex_lock(&priv->mutex);
3735 IWL_DEBUG_INFO(priv, "proceeding to add station %pM\n",
3736 sta->addr);
3737 sta_priv->common.sta_id = IWL_INVALID_STATION;
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003738
3739 atomic_set(&sta_priv->pending_frames, 0);
3740 if (vif->type == NL80211_IFTYPE_AP)
3741 sta_priv->client = true;
3742
Johannes Berga194e322010-08-27 08:53:46 -07003743 ret = iwl_add_station_common(priv, vif_priv->ctx, sta->addr,
3744 is_ap, &sta->ht_cap, &sta_id);
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003745 if (ret) {
3746 IWL_ERR(priv, "Unable to add station %pM (%d)\n",
3747 sta->addr, ret);
3748 /* Should we return success if return code is EEXIST ? */
Reinette Chatreda5ae1c2010-05-28 09:28:39 -07003749 mutex_unlock(&priv->mutex);
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003750 return ret;
3751 }
3752
Johannes Bergfd1af152010-04-30 11:30:43 -07003753 sta_priv->common.sta_id = sta_id;
3754
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003755 /* Initialize rate scaling */
Frans Pop91dd6c22010-03-24 14:19:58 -07003756 IWL_DEBUG_INFO(priv, "Initializing rate scaling for station %pM\n",
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003757 sta->addr);
3758 iwl_rs_rate_init(priv, sta, sta_id);
Reinette Chatreda5ae1c2010-05-28 09:28:39 -07003759 mutex_unlock(&priv->mutex);
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003760
Johannes Bergfd1af152010-04-30 11:30:43 -07003761 return 0;
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08003762}
3763
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003764static void iwl_mac_channel_switch(struct ieee80211_hw *hw,
3765 struct ieee80211_channel_switch *ch_switch)
3766{
3767 struct iwl_priv *priv = hw->priv;
3768 const struct iwl_channel_info *ch_info;
3769 struct ieee80211_conf *conf = &hw->conf;
Shanyu Zhaoaa2dc6b2010-07-28 13:40:39 -07003770 struct ieee80211_channel *channel = ch_switch->channel;
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003771 struct iwl_ht_config *ht_conf = &priv->current_ht_config;
Johannes Berg246ed352010-08-23 10:46:32 +02003772 /*
3773 * MULTI-FIXME
3774 * When we add support for multiple interfaces, we need to
3775 * revisit this. The channel switch command in the device
3776 * only affects the BSS context, but what does that really
3777 * mean? And what if we get a CSA on the second interface?
3778 * This needs a lot of work.
3779 */
3780 struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003781 u16 ch;
3782 unsigned long flags = 0;
3783
3784 IWL_DEBUG_MAC80211(priv, "enter\n");
3785
3786 if (iwl_is_rfkill(priv))
3787 goto out_exit;
3788
3789 if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
3790 test_bit(STATUS_SCANNING, &priv->status))
3791 goto out_exit;
3792
Johannes Berg246ed352010-08-23 10:46:32 +02003793 if (!iwl_is_associated_ctx(ctx))
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003794 goto out_exit;
3795
3796 /* channel switch in progress */
3797 if (priv->switch_rxon.switch_in_progress == true)
3798 goto out_exit;
3799
3800 mutex_lock(&priv->mutex);
3801 if (priv->cfg->ops->lib->set_channel_switch) {
3802
Shanyu Zhaoaa2dc6b2010-07-28 13:40:39 -07003803 ch = channel->hw_value;
Johannes Berg246ed352010-08-23 10:46:32 +02003804 if (le16_to_cpu(ctx->active.channel) != ch) {
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003805 ch_info = iwl_get_channel_info(priv,
Shanyu Zhaoaa2dc6b2010-07-28 13:40:39 -07003806 channel->band,
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003807 ch);
3808 if (!is_channel_valid(ch_info)) {
3809 IWL_DEBUG_MAC80211(priv, "invalid channel\n");
3810 goto out;
3811 }
3812 spin_lock_irqsave(&priv->lock, flags);
3813
3814 priv->current_ht_config.smps = conf->smps_mode;
3815
3816 /* Configure HT40 channels */
3817 ht_conf->is_ht = conf_is_ht(conf);
3818 if (ht_conf->is_ht) {
3819 if (conf_is_ht40_minus(conf)) {
3820 ht_conf->extension_chan_offset =
3821 IEEE80211_HT_PARAM_CHA_SEC_BELOW;
3822 ht_conf->is_40mhz = true;
3823 } else if (conf_is_ht40_plus(conf)) {
3824 ht_conf->extension_chan_offset =
3825 IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
3826 ht_conf->is_40mhz = true;
3827 } else {
3828 ht_conf->extension_chan_offset =
3829 IEEE80211_HT_PARAM_CHA_SEC_NONE;
3830 ht_conf->is_40mhz = false;
3831 }
3832 } else
3833 ht_conf->is_40mhz = false;
3834
Johannes Berg246ed352010-08-23 10:46:32 +02003835 if ((le16_to_cpu(ctx->staging.channel) != ch))
3836 ctx->staging.flags = 0;
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003837
Johannes Berg246ed352010-08-23 10:46:32 +02003838 iwl_set_rxon_channel(priv, channel, ctx);
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003839 iwl_set_rxon_ht(priv, ht_conf);
Johannes Berg246ed352010-08-23 10:46:32 +02003840 iwl_set_flags_for_band(priv, ctx, channel->band,
Wey-Yi Guy79d07322010-05-06 08:54:11 -07003841 priv->vif);
3842 spin_unlock_irqrestore(&priv->lock, flags);
3843
3844 iwl_set_rate(priv);
3845 /*
3846 * at this point, staging_rxon has the
3847 * configuration for channel switch
3848 */
3849 if (priv->cfg->ops->lib->set_channel_switch(priv,
3850 ch_switch))
3851 priv->switch_rxon.switch_in_progress = false;
3852 }
3853 }
3854out:
3855 mutex_unlock(&priv->mutex);
3856out_exit:
3857 if (!priv->switch_rxon.switch_in_progress)
3858 ieee80211_chswitch_done(priv->vif, false);
3859 IWL_DEBUG_MAC80211(priv, "leave\n");
3860}
3861
Johannes Berg8b8ab9d2010-08-17 11:24:01 +02003862static void iwlagn_configure_filter(struct ieee80211_hw *hw,
3863 unsigned int changed_flags,
3864 unsigned int *total_flags,
3865 u64 multicast)
3866{
3867 struct iwl_priv *priv = hw->priv;
3868 __le32 filter_or = 0, filter_nand = 0;
Johannes Berg246ed352010-08-23 10:46:32 +02003869 struct iwl_rxon_context *ctx;
Johannes Berg8b8ab9d2010-08-17 11:24:01 +02003870
3871#define CHK(test, flag) do { \
3872 if (*total_flags & (test)) \
3873 filter_or |= (flag); \
3874 else \
3875 filter_nand |= (flag); \
3876 } while (0)
3877
3878 IWL_DEBUG_MAC80211(priv, "Enter: changed: 0x%x, total: 0x%x\n",
3879 changed_flags, *total_flags);
3880
3881 CHK(FIF_OTHER_BSS | FIF_PROMISC_IN_BSS, RXON_FILTER_PROMISC_MSK);
3882 CHK(FIF_CONTROL, RXON_FILTER_CTL2HOST_MSK);
3883 CHK(FIF_BCN_PRBRESP_PROMISC, RXON_FILTER_BCON_AWARE_MSK);
3884
3885#undef CHK
3886
3887 mutex_lock(&priv->mutex);
3888
Johannes Berg246ed352010-08-23 10:46:32 +02003889 for_each_context(priv, ctx) {
3890 ctx->staging.filter_flags &= ~filter_nand;
3891 ctx->staging.filter_flags |= filter_or;
3892 iwlcore_commit_rxon(priv, ctx);
3893 }
Johannes Berg8b8ab9d2010-08-17 11:24:01 +02003894
3895 mutex_unlock(&priv->mutex);
3896
3897 /*
3898 * Receiving all multicast frames is always enabled by the
3899 * default flags setup in iwl_connection_init_rx_config()
3900 * since we currently do not support programming multicast
3901 * filters into the device.
3902 */
3903 *total_flags &= FIF_OTHER_BSS | FIF_ALLMULTI | FIF_PROMISC_IN_BSS |
3904 FIF_BCN_PRBRESP_PROMISC | FIF_CONTROL;
3905}
3906
Wey-Yi Guy716c74b2010-06-24 13:22:36 -07003907static void iwl_mac_flush(struct ieee80211_hw *hw, bool drop)
3908{
3909 struct iwl_priv *priv = hw->priv;
3910
3911 mutex_lock(&priv->mutex);
3912 IWL_DEBUG_MAC80211(priv, "enter\n");
3913
3914 /* do not support "flush" */
3915 if (!priv->cfg->ops->lib->txfifo_flush)
3916 goto done;
3917
3918 if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
3919 IWL_DEBUG_TX(priv, "Aborting flush due to device shutdown\n");
3920 goto done;
3921 }
3922 if (iwl_is_rfkill(priv)) {
3923 IWL_DEBUG_TX(priv, "Aborting flush due to RF Kill\n");
3924 goto done;
3925 }
3926
3927 /*
3928 * mac80211 will not push any more frames for transmit
3929 * until the flush is completed
3930 */
3931 if (drop) {
3932 IWL_DEBUG_MAC80211(priv, "send flush command\n");
3933 if (priv->cfg->ops->lib->txfifo_flush(priv, IWL_DROP_ALL)) {
3934 IWL_ERR(priv, "flush request fail\n");
3935 goto done;
3936 }
3937 }
3938 IWL_DEBUG_MAC80211(priv, "wait transmit/flush all frames\n");
3939 iwlagn_wait_tx_queue_empty(priv);
3940done:
3941 mutex_unlock(&priv->mutex);
3942 IWL_DEBUG_MAC80211(priv, "leave\n");
3943}
3944
Zhu Yib481de92007-09-25 17:54:57 -07003945/*****************************************************************************
3946 *
Zhu Yib481de92007-09-25 17:54:57 -07003947 * driver setup and teardown
3948 *
3949 *****************************************************************************/
3950
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08003951static void iwl_setup_deferred_work(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07003952{
Reinette Chatred21050c2009-02-13 11:51:18 -08003953 priv->workqueue = create_singlethread_workqueue(DRV_NAME);
Zhu Yib481de92007-09-25 17:54:57 -07003954
3955 init_waitqueue_head(&priv->wait_command_queue);
3956
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003957 INIT_WORK(&priv->restart, iwl_bg_restart);
3958 INIT_WORK(&priv->rx_replenish, iwl_bg_rx_replenish);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003959 INIT_WORK(&priv->beacon_update, iwl_bg_beacon_update);
Emmanuel Grumbach16e727e2008-06-12 09:46:52 +08003960 INIT_WORK(&priv->run_time_calib_work, iwl_bg_run_time_calib_work);
Wey-Yi Guy65550632010-06-24 13:18:35 -07003961 INIT_WORK(&priv->tx_flush, iwl_bg_tx_flush);
Wey-Yi Guybee008b2010-08-23 07:57:04 -07003962 INIT_WORK(&priv->bt_full_concurrency, iwl_bg_bt_full_concurrency);
Wey-Yi Guyfbba9412010-08-23 07:57:10 -07003963 INIT_WORK(&priv->bt_runtime_config, iwl_bg_bt_runtime_config);
Tomas Winkler4a4a9e82008-05-29 16:34:54 +08003964 INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
3965 INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
Tomas Winkler2a421b92008-06-12 09:47:10 +08003966
Tomas Winkler2a421b92008-06-12 09:47:10 +08003967 iwl_setup_scan_deferred_work(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003968
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08003969 if (priv->cfg->ops->lib->setup_deferred_work)
3970 priv->cfg->ops->lib->setup_deferred_work(priv);
3971
3972 init_timer(&priv->statistics_periodic);
3973 priv->statistics_periodic.data = (unsigned long)priv;
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07003974 priv->statistics_periodic.function = iwl_bg_statistics_periodic;
Zhu Yib481de92007-09-25 17:54:57 -07003975
Wey-Yi Guya9e1cb62009-12-10 14:37:26 -08003976 init_timer(&priv->ucode_trace);
3977 priv->ucode_trace.data = (unsigned long)priv;
3978 priv->ucode_trace.function = iwl_bg_ucode_trace;
3979
Wey-Yi Guyb74e31a2010-03-01 17:23:50 -08003980 if (priv->cfg->ops->lib->recover_from_tx_stall) {
3981 init_timer(&priv->monitor_recover);
3982 priv->monitor_recover.data = (unsigned long)priv;
3983 priv->monitor_recover.function =
3984 priv->cfg->ops->lib->recover_from_tx_stall;
3985 }
3986
Mohamed Abbasef850d72009-05-22 11:01:50 -07003987 if (!priv->cfg->use_isr_legacy)
3988 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
3989 iwl_irq_tasklet, (unsigned long)priv);
3990 else
3991 tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
3992 iwl_irq_tasklet_legacy, (unsigned long)priv);
Zhu Yib481de92007-09-25 17:54:57 -07003993}
3994
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08003995static void iwl_cancel_deferred_work(struct iwl_priv *priv)
Zhu Yib481de92007-09-25 17:54:57 -07003996{
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08003997 if (priv->cfg->ops->lib->cancel_deferred_work)
3998 priv->cfg->ops->lib->cancel_deferred_work(priv);
Zhu Yib481de92007-09-25 17:54:57 -07003999
Joonwoo Park3ae6a052007-11-29 10:43:16 +09004000 cancel_delayed_work_sync(&priv->init_alive_start);
Zhu Yib481de92007-09-25 17:54:57 -07004001 cancel_delayed_work(&priv->scan_check);
Johannes Berg88be0262010-04-07 00:21:36 -07004002 cancel_work_sync(&priv->start_internal_scan);
Zhu Yib481de92007-09-25 17:54:57 -07004003 cancel_delayed_work(&priv->alive_start);
Wey-Yi Guy815e6292010-06-03 10:14:01 -07004004 cancel_work_sync(&priv->run_time_calib_work);
Zhu Yib481de92007-09-25 17:54:57 -07004005 cancel_work_sync(&priv->beacon_update);
Wey-Yi Guybee008b2010-08-23 07:57:04 -07004006 cancel_work_sync(&priv->bt_full_concurrency);
Wey-Yi Guyfbba9412010-08-23 07:57:10 -07004007 cancel_work_sync(&priv->bt_runtime_config);
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08004008 del_timer_sync(&priv->statistics_periodic);
Wey-Yi Guya9e1cb62009-12-10 14:37:26 -08004009 del_timer_sync(&priv->ucode_trace);
Zhu Yib481de92007-09-25 17:54:57 -07004010}
4011
Reinette Chatre89f186a2009-10-30 14:36:11 -07004012static void iwl_init_hw_rates(struct iwl_priv *priv,
4013 struct ieee80211_rate *rates)
4014{
4015 int i;
4016
4017 for (i = 0; i < IWL_RATE_COUNT_LEGACY; i++) {
4018 rates[i].bitrate = iwl_rates[i].ieee * 5;
4019 rates[i].hw_value = i; /* Rate scaling will work on indexes */
4020 rates[i].hw_value_short = i;
4021 rates[i].flags = 0;
4022 if ((i >= IWL_FIRST_CCK_RATE) && (i <= IWL_LAST_CCK_RATE)) {
4023 /*
4024 * If CCK != 1M then set short preamble rate flag.
4025 */
4026 rates[i].flags |=
4027 (iwl_rates[i].plcp == IWL_RATE_1M_PLCP) ?
4028 0 : IEEE80211_RATE_SHORT_PREAMBLE;
4029 }
4030 }
4031}
4032
4033static int iwl_init_drv(struct iwl_priv *priv)
4034{
4035 int ret;
4036
4037 priv->ibss_beacon = NULL;
4038
Reinette Chatre89f186a2009-10-30 14:36:11 -07004039 spin_lock_init(&priv->sta_lock);
4040 spin_lock_init(&priv->hcmd_lock);
4041
4042 INIT_LIST_HEAD(&priv->free_frames);
4043
4044 mutex_init(&priv->mutex);
Reinette Chatred2dfe6d2010-02-18 22:03:04 -08004045 mutex_init(&priv->sync_cmd_mutex);
Reinette Chatre89f186a2009-10-30 14:36:11 -07004046
Reinette Chatre89f186a2009-10-30 14:36:11 -07004047 priv->ieee_channels = NULL;
4048 priv->ieee_rates = NULL;
4049 priv->band = IEEE80211_BAND_2GHZ;
4050
4051 priv->iw_mode = NL80211_IFTYPE_STATION;
Johannes Bergba37a3d2009-12-10 14:37:27 -08004052 priv->current_ht_config.smps = IEEE80211_SMPS_STATIC;
Wey-Yi Guya13d2762010-01-22 14:22:42 -08004053 priv->missed_beacon_threshold = IWL_MISSED_BEACON_THRESHOLD_DEF;
Wey-Yi Guyd5a0ffa2010-03-04 13:38:59 -08004054 priv->_agn.agg_tids_count = 0;
Reinette Chatre89f186a2009-10-30 14:36:11 -07004055
Wey-Yi Guy8a472da2010-02-18 22:03:06 -08004056 /* initialize force reset */
4057 priv->force_reset[IWL_RF_RESET].reset_duration =
4058 IWL_DELAY_NEXT_FORCE_RF_RESET;
4059 priv->force_reset[IWL_FW_RESET].reset_duration =
4060 IWL_DELAY_NEXT_FORCE_FW_RELOAD;
Reinette Chatre89f186a2009-10-30 14:36:11 -07004061
4062 /* Choose which receivers/antennas to use */
4063 if (priv->cfg->ops->hcmd->set_rxon_chain)
Johannes Berg246ed352010-08-23 10:46:32 +02004064 priv->cfg->ops->hcmd->set_rxon_chain(priv,
4065 &priv->contexts[IWL_RXON_CTX_BSS]);
Reinette Chatre89f186a2009-10-30 14:36:11 -07004066
4067 iwl_init_scan_params(priv);
4068
Wey-Yi Guy22bf59a2010-08-23 07:57:11 -07004069 /* init bt coex */
4070 if (priv->cfg->advanced_bt_coexist) {
Wey-Yi Guyb6e116e2010-08-23 07:57:14 -07004071 priv->kill_ack_mask = IWLAGN_BT_KILL_ACK_MASK_DEFAULT;
4072 priv->kill_cts_mask = IWLAGN_BT_KILL_CTS_MASK_DEFAULT;
4073 priv->bt_valid = IWLAGN_BT_ALL_VALID_MSK;
Wey-Yi Guy22bf59a2010-08-23 07:57:11 -07004074 priv->bt_on_thresh = BT_ON_THRESHOLD_DEF;
4075 priv->bt_duration = BT_DURATION_LIMIT_DEF;
4076 priv->dynamic_frag_thresh = BT_FRAG_THRESHOLD_DEF;
4077 priv->dynamic_agg_thresh = BT_AGG_THRESHOLD_DEF;
4078 }
4079
Reinette Chatre89f186a2009-10-30 14:36:11 -07004080 /* Set the tx_power_user_lmt to the lowest power level
4081 * this value will get overwritten by channel max power avg
4082 * from eeprom */
Wey-Yi Guyb744cb72010-03-23 11:37:59 -07004083 priv->tx_power_user_lmt = IWLAGN_TX_POWER_TARGET_POWER_MIN;
Reinette Chatre89f186a2009-10-30 14:36:11 -07004084
4085 ret = iwl_init_channel_map(priv);
4086 if (ret) {
4087 IWL_ERR(priv, "initializing regulatory failed: %d\n", ret);
4088 goto err;
4089 }
4090
4091 ret = iwlcore_init_geos(priv);
4092 if (ret) {
4093 IWL_ERR(priv, "initializing geos failed: %d\n", ret);
4094 goto err_free_channel_map;
4095 }
4096 iwl_init_hw_rates(priv, priv->ieee_rates);
4097
4098 return 0;
4099
4100err_free_channel_map:
4101 iwl_free_channel_map(priv);
4102err:
4103 return ret;
4104}
4105
4106static void iwl_uninit_drv(struct iwl_priv *priv)
4107{
4108 iwl_calib_free_results(priv);
4109 iwlcore_free_geos(priv);
4110 iwl_free_channel_map(priv);
Johannes Berg811ecc92010-04-06 04:12:41 -07004111 kfree(priv->scan_cmd);
Reinette Chatre89f186a2009-10-30 14:36:11 -07004112}
4113
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004114static struct ieee80211_ops iwl_hw_ops = {
4115 .tx = iwl_mac_tx,
4116 .start = iwl_mac_start,
4117 .stop = iwl_mac_stop,
4118 .add_interface = iwl_mac_add_interface,
4119 .remove_interface = iwl_mac_remove_interface,
4120 .config = iwl_mac_config,
Johannes Berg8b8ab9d2010-08-17 11:24:01 +02004121 .configure_filter = iwlagn_configure_filter,
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004122 .set_key = iwl_mac_set_key,
4123 .update_tkip_key = iwl_mac_update_tkip_key,
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004124 .conf_tx = iwl_mac_conf_tx,
4125 .reset_tsf = iwl_mac_reset_tsf,
4126 .bss_info_changed = iwl_bss_info_changed,
4127 .ampdu_action = iwl_mac_ampdu_action,
Johannes Berg6ab10ff2009-11-13 11:56:37 -08004128 .hw_scan = iwl_mac_hw_scan,
4129 .sta_notify = iwl_mac_sta_notify,
Reinette Chatrefe6b23d2010-02-22 16:24:47 -08004130 .sta_add = iwlagn_mac_sta_add,
4131 .sta_remove = iwl_mac_sta_remove,
Wey-Yi Guy79d07322010-05-06 08:54:11 -07004132 .channel_switch = iwl_mac_channel_switch,
Wey-Yi Guy716c74b2010-06-24 13:22:36 -07004133 .flush = iwl_mac_flush,
Johannes Berga85d7cc2010-07-31 08:34:10 -07004134 .tx_last_beacon = iwl_mac_tx_last_beacon,
Zhu Yib481de92007-09-25 17:54:57 -07004135};
4136
Wey-Yi Guy3867fe02010-07-31 08:34:05 -07004137static void iwl_hw_detect(struct iwl_priv *priv)
4138{
4139 priv->hw_rev = _iwl_read32(priv, CSR_HW_REV);
4140 priv->hw_wa_rev = _iwl_read32(priv, CSR_HW_REV_WA_REG);
4141 pci_read_config_byte(priv->pci_dev, PCI_REVISION_ID, &priv->rev_id);
Wey-Yi Guy49ded762010-07-31 08:34:06 -07004142 IWL_DEBUG_INFO(priv, "HW Revision ID = 0x%X\n", priv->rev_id);
Wey-Yi Guy3867fe02010-07-31 08:34:05 -07004143}
4144
Wey-Yi Guy07d4f1a2010-07-31 08:34:08 -07004145static int iwl_set_hw_params(struct iwl_priv *priv)
4146{
4147 priv->hw_params.max_rxq_size = RX_QUEUE_SIZE;
4148 priv->hw_params.max_rxq_log = RX_QUEUE_SIZE_LOG;
4149 if (priv->cfg->mod_params->amsdu_size_8K)
4150 priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_8K);
4151 else
4152 priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_4K);
4153
4154 priv->hw_params.max_beacon_itrvl = IWL_MAX_UCODE_BEACON_INTERVAL;
4155
4156 if (priv->cfg->mod_params->disable_11n)
4157 priv->cfg->sku &= ~IWL_SKU_N;
4158
4159 /* Device-specific setup */
4160 return priv->cfg->ops->lib->set_hw_params(priv);
4161}
4162
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004163static int iwl_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
Zhu Yib481de92007-09-25 17:54:57 -07004164{
Johannes Berg246ed352010-08-23 10:46:32 +02004165 int err = 0, i;
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07004166 struct iwl_priv *priv;
Zhu Yib481de92007-09-25 17:54:57 -07004167 struct ieee80211_hw *hw;
Tomas Winkler82b9a122008-03-04 18:09:30 -08004168 struct iwl_cfg *cfg = (struct iwl_cfg *)(ent->driver_data);
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004169 unsigned long flags;
Wey-Yi Guyc6fa17e2010-07-15 05:58:30 -07004170 u16 pci_cmd, num_mac;
Zhu Yib481de92007-09-25 17:54:57 -07004171
Assaf Krauss316c30d2008-03-14 10:38:46 -07004172 /************************
4173 * 1. Allocating HW data
4174 ************************/
4175
Cahill, Ben M6440adb2007-11-29 11:09:55 +08004176 /* Disabling hardware scan means that mac80211 will perform scans
4177 * "the hard way", rather than using device's scan. */
Assaf Krauss1ea87392008-03-18 14:57:50 -07004178 if (cfg->mod_params->disable_hw_scan) {
Reinette Chatrea562a9d2009-07-17 09:30:24 -07004179 if (iwl_debug_level & IWL_DL_INFO)
Ester Kummerbf403db2008-05-05 10:22:40 +08004180 dev_printk(KERN_DEBUG, &(pdev->dev),
4181 "Disabling hw_scan\n");
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004182 iwl_hw_ops.hw_scan = NULL;
Zhu Yib481de92007-09-25 17:54:57 -07004183 }
4184
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004185 hw = iwl_alloc_all(cfg, &iwl_hw_ops);
Assaf Krauss1d0a0822008-03-14 10:38:48 -07004186 if (!hw) {
Zhu Yib481de92007-09-25 17:54:57 -07004187 err = -ENOMEM;
4188 goto out;
4189 }
Assaf Krauss1d0a0822008-03-14 10:38:48 -07004190 priv = hw->priv;
4191 /* At this point both hw and priv are allocated. */
4192
Johannes Berg246ed352010-08-23 10:46:32 +02004193 /*
4194 * The default context is always valid,
4195 * more may be discovered when firmware
4196 * is loaded.
4197 */
4198 priv->valid_contexts = BIT(IWL_RXON_CTX_BSS);
4199
4200 for (i = 0; i < NUM_IWL_RXON_CTX; i++)
4201 priv->contexts[i].ctxid = i;
4202
Johannes Berg8f2d3d22010-08-23 10:46:37 +02004203 priv->contexts[IWL_RXON_CTX_BSS].rxon_cmd = REPLY_RXON;
4204 priv->contexts[IWL_RXON_CTX_BSS].rxon_timing_cmd = REPLY_RXON_TIMING;
4205 priv->contexts[IWL_RXON_CTX_BSS].rxon_assoc_cmd = REPLY_RXON_ASSOC;
4206 BUILD_BUG_ON(NUM_IWL_RXON_CTX != 1);
4207
Zhu Yib481de92007-09-25 17:54:57 -07004208 SET_IEEE80211_DEV(hw, &pdev->dev);
4209
Tomas Winklere1623442009-01-27 14:27:56 -08004210 IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
Tomas Winkler82b9a122008-03-04 18:09:30 -08004211 priv->cfg = cfg;
Zhu Yib481de92007-09-25 17:54:57 -07004212 priv->pci_dev = pdev;
Mohamed Abbas40cefda2009-05-22 11:01:52 -07004213 priv->inta_mask = CSR_INI_SET_MASK;
Assaf Krauss316c30d2008-03-14 10:38:46 -07004214
Wey-Yi Guybee008b2010-08-23 07:57:04 -07004215 /* is antenna coupling more than 35dB ? */
4216 priv->bt_ant_couple_ok =
4217 (iwlagn_ant_coupling > IWL_BT_ANTENNA_COUPLING_THRESHOLD) ?
4218 true : false;
4219
Wey-Yi Guyf37837c2010-08-23 07:57:12 -07004220 /* enable/disable bt channel announcement */
4221 priv->bt_ch_announce = iwlagn_bt_ch_announce;
4222
Wey-Yi Guy20594eb2009-08-07 15:41:39 -07004223 if (iwl_alloc_traffic_mem(priv))
4224 IWL_ERR(priv, "Not enough memory to generate traffic log\n");
Zhu Yib481de92007-09-25 17:54:57 -07004225
Assaf Krauss316c30d2008-03-14 10:38:46 -07004226 /**************************
4227 * 2. Initializing PCI bus
4228 **************************/
John W. Linville1a7123c2010-08-05 14:39:31 -04004229 pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 |
4230 PCIE_LINK_STATE_CLKPM);
4231
Assaf Krauss316c30d2008-03-14 10:38:46 -07004232 if (pci_enable_device(pdev)) {
4233 err = -ENODEV;
4234 goto out_ieee80211_free_hw;
4235 }
4236
4237 pci_set_master(pdev);
4238
Winkler, Tomas093d874c2008-09-26 15:09:34 +08004239 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(36));
Assaf Krauss316c30d2008-03-14 10:38:46 -07004240 if (!err)
Winkler, Tomas093d874c2008-09-26 15:09:34 +08004241 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(36));
Ron Rindjunskycc2a8ea2008-04-21 15:41:59 -07004242 if (err) {
Winkler, Tomas093d874c2008-09-26 15:09:34 +08004243 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
Ron Rindjunskycc2a8ea2008-04-21 15:41:59 -07004244 if (!err)
Winkler, Tomas093d874c2008-09-26 15:09:34 +08004245 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
Ron Rindjunskycc2a8ea2008-04-21 15:41:59 -07004246 /* both attempts failed: */
Assaf Krauss316c30d2008-03-14 10:38:46 -07004247 if (err) {
Tomas Winkler978785a2008-12-19 10:37:31 +08004248 IWL_WARN(priv, "No suitable DMA available.\n");
Assaf Krauss316c30d2008-03-14 10:38:46 -07004249 goto out_pci_disable_device;
Ron Rindjunskycc2a8ea2008-04-21 15:41:59 -07004250 }
Assaf Krauss316c30d2008-03-14 10:38:46 -07004251 }
4252
4253 err = pci_request_regions(pdev, DRV_NAME);
4254 if (err)
4255 goto out_pci_disable_device;
4256
4257 pci_set_drvdata(pdev, priv);
4258
Assaf Krauss316c30d2008-03-14 10:38:46 -07004259
4260 /***********************
4261 * 3. Read REV register
4262 ***********************/
4263 priv->hw_base = pci_iomap(pdev, 0, 0);
4264 if (!priv->hw_base) {
4265 err = -ENODEV;
4266 goto out_pci_release_regions;
4267 }
4268
Tomas Winklere1623442009-01-27 14:27:56 -08004269 IWL_DEBUG_INFO(priv, "pci_resource_len = 0x%08llx\n",
Assaf Krauss316c30d2008-03-14 10:38:46 -07004270 (unsigned long long) pci_resource_len(pdev, 0));
Tomas Winklere1623442009-01-27 14:27:56 -08004271 IWL_DEBUG_INFO(priv, "pci_resource_base = %p\n", priv->hw_base);
Assaf Krauss316c30d2008-03-14 10:38:46 -07004272
Reinette Chatre731a29b2009-12-14 14:12:11 -08004273 /* these spin locks will be used in apm_ops.init and EEPROM access
Mohamed Abbasa8b50a02009-05-22 11:01:47 -07004274 * we should init now
4275 */
4276 spin_lock_init(&priv->reg_lock);
Reinette Chatre731a29b2009-12-14 14:12:11 -08004277 spin_lock_init(&priv->lock);
Reinette Chatre4843b5a2010-02-03 09:38:59 -08004278
4279 /*
4280 * stop and reset the on-board processor just in case it is in a
4281 * strange state ... like being left stranded by a primary kernel
4282 * and this is now the kdump kernel trying to start up
4283 */
4284 iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
4285
Tomas Winklerb661c812008-04-23 17:14:54 -07004286 iwl_hw_detect(priv);
Shanyu Zhaoc11362c2010-03-05 17:05:20 -08004287 IWL_INFO(priv, "Detected %s, REV=0x%X\n",
Tomas Winklerb661c812008-04-23 17:14:54 -07004288 priv->cfg->name, priv->hw_rev);
Assaf Krauss316c30d2008-03-14 10:38:46 -07004289
Tomas Winklere7b63582008-09-03 11:26:49 +08004290 /* We disable the RETRY_TIMEOUT register (0x41) to keep
4291 * PCI Tx retries from interfering with C3 CPU state */
4292 pci_write_config_byte(pdev, PCI_CFG_RETRY_TIMEOUT, 0x00);
4293
Mohamed Abbas086ed112009-05-22 11:01:54 -07004294 iwl_prepare_card_hw(priv);
4295 if (!priv->hw_ready) {
4296 IWL_WARN(priv, "Failed, HW not ready\n");
4297 goto out_iounmap;
4298 }
4299
Assaf Krauss316c30d2008-03-14 10:38:46 -07004300 /*****************
4301 * 4. Read EEPROM
4302 *****************/
Assaf Krauss316c30d2008-03-14 10:38:46 -07004303 /* Read the EEPROM */
4304 err = iwl_eeprom_init(priv);
4305 if (err) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08004306 IWL_ERR(priv, "Unable to init EEPROM\n");
Assaf Krauss316c30d2008-03-14 10:38:46 -07004307 goto out_iounmap;
4308 }
Tomas Winkler8614f362008-04-23 17:14:55 -07004309 err = iwl_eeprom_check_version(priv);
4310 if (err)
Reinette Chatrec8f16132009-02-27 16:21:22 -08004311 goto out_free_eeprom;
Tomas Winkler8614f362008-04-23 17:14:55 -07004312
Ron Rindjunsky02883012008-05-15 13:53:53 +08004313 /* extract MAC Address */
Wey-Yi Guyc6fa17e2010-07-15 05:58:30 -07004314 iwl_eeprom_get_mac(priv, priv->addresses[0].addr);
4315 IWL_DEBUG_INFO(priv, "MAC address: %pM\n", priv->addresses[0].addr);
4316 priv->hw->wiphy->addresses = priv->addresses;
4317 priv->hw->wiphy->n_addresses = 1;
4318 num_mac = iwl_eeprom_query16(priv, EEPROM_NUM_MAC_ADDRESS);
4319 if (num_mac > 1) {
4320 memcpy(priv->addresses[1].addr, priv->addresses[0].addr,
4321 ETH_ALEN);
4322 priv->addresses[1].addr[5]++;
4323 priv->hw->wiphy->n_addresses++;
4324 }
Assaf Krauss316c30d2008-03-14 10:38:46 -07004325
4326 /************************
4327 * 5. Setup HW constants
4328 ************************/
Ron Rindjunskyda154e302008-06-30 17:23:20 +08004329 if (iwl_set_hw_params(priv)) {
Winkler, Tomas15b16872008-12-19 10:37:33 +08004330 IWL_ERR(priv, "failed to set hw parameters\n");
Tomas Winkler073d3f52008-04-21 15:41:52 -07004331 goto out_free_eeprom;
Assaf Krauss316c30d2008-03-14 10:38:46 -07004332 }
4333
4334 /*******************
Tomas Winkler6ba87952008-05-15 13:54:17 +08004335 * 6. Setup priv
Assaf Krauss316c30d2008-03-14 10:38:46 -07004336 *******************/
Zhu Yib481de92007-09-25 17:54:57 -07004337
Tomas Winkler6ba87952008-05-15 13:54:17 +08004338 err = iwl_init_drv(priv);
Assaf Kraussbf85ea42008-03-14 10:38:49 -07004339 if (err)
Ron Rindjunsky399f4902008-04-23 17:14:56 -07004340 goto out_free_eeprom;
Assaf Kraussbf85ea42008-03-14 10:38:49 -07004341 /* At this point both hw and priv are initialized. */
Assaf Krauss316c30d2008-03-14 10:38:46 -07004342
Assaf Krauss316c30d2008-03-14 10:38:46 -07004343 /********************
Abhijeet Kolekar09f9bf72009-04-20 14:37:03 -07004344 * 7. Setup services
Assaf Krauss316c30d2008-03-14 10:38:46 -07004345 ********************/
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004346 spin_lock_irqsave(&priv->lock, flags);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004347 iwl_disable_interrupts(priv);
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004348 spin_unlock_irqrestore(&priv->lock, flags);
Assaf Krauss316c30d2008-03-14 10:38:46 -07004349
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004350 pci_enable_msi(priv->pci_dev);
4351
Mohamed Abbasef850d72009-05-22 11:01:50 -07004352 iwl_alloc_isr_ict(priv);
4353 err = request_irq(priv->pci_dev->irq, priv->cfg->ops->lib->isr,
4354 IRQF_SHARED, DRV_NAME, priv);
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004355 if (err) {
4356 IWL_ERR(priv, "Error allocating IRQ %d\n", priv->pci_dev->irq);
4357 goto out_disable_msi;
4358 }
Assaf Krauss316c30d2008-03-14 10:38:46 -07004359
Emmanuel Grumbach4e393172008-06-12 09:46:53 +08004360 iwl_setup_deferred_work(priv);
Emmanuel Grumbach653fa4a2008-06-30 17:23:11 +08004361 iwl_setup_rx_handlers(priv);
Assaf Krauss316c30d2008-03-14 10:38:46 -07004362
Johannes Berg158bea02010-01-22 14:22:53 -08004363 /*********************************************
4364 * 8. Enable interrupts and read RFKILL state
4365 *********************************************/
Tomas Winkler6ba87952008-05-15 13:54:17 +08004366
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004367 /* enable interrupts if needed: hw bug w/a */
4368 pci_read_config_word(priv->pci_dev, PCI_COMMAND, &pci_cmd);
4369 if (pci_cmd & PCI_COMMAND_INTX_DISABLE) {
4370 pci_cmd &= ~PCI_COMMAND_INTX_DISABLE;
4371 pci_write_config_word(priv->pci_dev, PCI_COMMAND, pci_cmd);
4372 }
4373
4374 iwl_enable_interrupts(priv);
4375
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004376 /* If platform's RF_KILL switch is NOT set to KILL */
4377 if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
4378 clear_bit(STATUS_RF_KILL_HW, &priv->status);
4379 else
4380 set_bit(STATUS_RF_KILL_HW, &priv->status);
Tomas Winkler6ba87952008-05-15 13:54:17 +08004381
Johannes Berga60e77e2009-06-04 18:26:06 +02004382 wiphy_rfkill_set_hw_state(priv->hw->wiphy,
4383 test_bit(STATUS_RF_KILL_HW, &priv->status));
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004384
Emmanuel Grumbach58d0f362008-06-12 09:47:19 +08004385 iwl_power_initialize(priv);
Wey-Yi Guy39b73fb12009-07-24 11:13:02 -07004386 iwl_tt_initialize(priv);
Johannes Berg158bea02010-01-22 14:22:53 -08004387
Reinette Chatrea15707d2010-05-10 15:08:11 -07004388 init_completion(&priv->_agn.firmware_loading_complete);
Johannes Berg562db532010-04-29 07:41:53 -07004389
Johannes Bergb08dfd02010-01-29 11:54:56 -08004390 err = iwl_request_firmware(priv, true);
Johannes Berg158bea02010-01-22 14:22:53 -08004391 if (err)
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07004392 goto out_destroy_workqueue;
Johannes Berg158bea02010-01-22 14:22:53 -08004393
Zhu Yib481de92007-09-25 17:54:57 -07004394 return 0;
4395
Emmanuel Grumbach7d476182010-05-23 00:14:08 -07004396 out_destroy_workqueue:
Reinette Chatrec8f16132009-02-27 16:21:22 -08004397 destroy_workqueue(priv->workqueue);
4398 priv->workqueue = NULL;
Helmut Schaa795cc0a2009-02-12 18:51:03 +01004399 free_irq(priv->pci_dev->irq, priv);
Mohamed Abbasef850d72009-05-22 11:01:50 -07004400 iwl_free_isr_ict(priv);
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004401 out_disable_msi:
4402 pci_disable_msi(priv->pci_dev);
Tomas Winkler6ba87952008-05-15 13:54:17 +08004403 iwl_uninit_drv(priv);
Tomas Winkler073d3f52008-04-21 15:41:52 -07004404 out_free_eeprom:
4405 iwl_eeprom_free(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004406 out_iounmap:
4407 pci_iounmap(pdev, priv->hw_base);
4408 out_pci_release_regions:
Assaf Krauss316c30d2008-03-14 10:38:46 -07004409 pci_set_drvdata(pdev, NULL);
Reinette Chatre623d5632009-03-03 11:37:04 -08004410 pci_release_regions(pdev);
Zhu Yib481de92007-09-25 17:54:57 -07004411 out_pci_disable_device:
4412 pci_disable_device(pdev);
Zhu Yib481de92007-09-25 17:54:57 -07004413 out_ieee80211_free_hw:
Wey-Yi Guy20594eb2009-08-07 15:41:39 -07004414 iwl_free_traffic_mem(priv);
Wey-Yi Guyd7c76f42009-10-09 13:20:17 -07004415 ieee80211_free_hw(priv->hw);
Zhu Yib481de92007-09-25 17:54:57 -07004416 out:
4417 return err;
4418}
4419
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004420static void __devexit iwl_pci_remove(struct pci_dev *pdev)
Zhu Yib481de92007-09-25 17:54:57 -07004421{
Tomas Winklerc79dd5b2008-03-12 16:58:50 -07004422 struct iwl_priv *priv = pci_get_drvdata(pdev);
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004423 unsigned long flags;
Zhu Yib481de92007-09-25 17:54:57 -07004424
4425 if (!priv)
4426 return;
4427
Reinette Chatrea15707d2010-05-10 15:08:11 -07004428 wait_for_completion(&priv->_agn.firmware_loading_complete);
Johannes Berg562db532010-04-29 07:41:53 -07004429
Tomas Winklere1623442009-01-27 14:27:56 -08004430 IWL_DEBUG_INFO(priv, "*** UNLOAD DRIVER ***\n");
Zhu Yib481de92007-09-25 17:54:57 -07004431
Emmanuel Grumbach67249622008-05-29 16:35:26 +08004432 iwl_dbgfs_unregister(priv);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004433 sysfs_remove_group(&pdev->dev.kobj, &iwl_attribute_group);
Emmanuel Grumbach67249622008-05-29 16:35:26 +08004434
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004435 /* ieee80211_unregister_hw call wil cause iwl_mac_stop to
4436 * to be called and iwl_down since we are removing the device
Gregory Greenman0b124c32008-09-03 11:18:50 +08004437 * we need to set STATUS_EXIT_PENDING bit.
4438 */
4439 set_bit(STATUS_EXIT_PENDING, &priv->status);
Ron Rindjunskyc4f55232008-03-28 16:21:10 -07004440 if (priv->mac80211_registered) {
4441 ieee80211_unregister_hw(priv->hw);
4442 priv->mac80211_registered = 0;
Gregory Greenman0b124c32008-09-03 11:18:50 +08004443 } else {
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004444 iwl_down(priv);
Ron Rindjunskyc4f55232008-03-28 16:21:10 -07004445 }
4446
Ben Cahillc166b252009-10-23 13:42:35 -07004447 /*
4448 * Make sure device is reset to low power before unloading driver.
4449 * This may be redundant with iwl_down(), but there are paths to
4450 * run iwl_down() without calling apm_ops.stop(), and there are
4451 * paths to avoid running iwl_down() at all before leaving driver.
4452 * This (inexpensive) call *makes sure* device is reset.
4453 */
4454 priv->cfg->ops->lib->apm_ops.stop(priv);
4455
Wey-Yi Guy39b73fb12009-07-24 11:13:02 -07004456 iwl_tt_exit(priv);
4457
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004458 /* make sure we flush any pending irq or
4459 * tasklet for the driver
4460 */
4461 spin_lock_irqsave(&priv->lock, flags);
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004462 iwl_disable_interrupts(priv);
Mohamed Abbas0359fac2008-03-28 16:21:08 -07004463 spin_unlock_irqrestore(&priv->lock, flags);
4464
4465 iwl_synchronize_irq(priv);
4466
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004467 iwl_dealloc_ucode_pci(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004468
4469 if (priv->rxq.bd)
Wey-Yi Guy54b81552010-03-17 13:34:35 -07004470 iwlagn_rx_queue_free(priv, &priv->rxq);
Wey-Yi Guy74bcdb32010-03-17 13:34:34 -07004471 iwlagn_hw_txq_ctx_free(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004472
Tomas Winkler073d3f52008-04-21 15:41:52 -07004473 iwl_eeprom_free(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004474
Zhu Yib481de92007-09-25 17:54:57 -07004475
Mohamed Abbas948c1712007-10-25 17:15:45 +08004476 /*netif_stop_queue(dev); */
4477 flush_workqueue(priv->workqueue);
4478
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004479 /* ieee80211_unregister_hw calls iwl_mac_stop, which flushes
Zhu Yib481de92007-09-25 17:54:57 -07004480 * priv->workqueue... so we can't take down the workqueue
4481 * until now... */
4482 destroy_workqueue(priv->workqueue);
4483 priv->workqueue = NULL;
Wey-Yi Guy20594eb2009-08-07 15:41:39 -07004484 iwl_free_traffic_mem(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004485
Helmut Schaa6cd0b1c2009-01-19 13:10:07 +01004486 free_irq(priv->pci_dev->irq, priv);
4487 pci_disable_msi(priv->pci_dev);
Zhu Yib481de92007-09-25 17:54:57 -07004488 pci_iounmap(pdev, priv->hw_base);
4489 pci_release_regions(pdev);
4490 pci_disable_device(pdev);
4491 pci_set_drvdata(pdev, NULL);
4492
Tomas Winkler6ba87952008-05-15 13:54:17 +08004493 iwl_uninit_drv(priv);
Zhu Yib481de92007-09-25 17:54:57 -07004494
Mohamed Abbasef850d72009-05-22 11:01:50 -07004495 iwl_free_isr_ict(priv);
4496
Zhu Yib481de92007-09-25 17:54:57 -07004497 if (priv->ibss_beacon)
4498 dev_kfree_skb(priv->ibss_beacon);
4499
4500 ieee80211_free_hw(priv->hw);
4501}
4502
Zhu Yib481de92007-09-25 17:54:57 -07004503
4504/*****************************************************************************
4505 *
4506 * driver and module entry point
4507 *
4508 *****************************************************************************/
4509
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004510/* Hardware specific file defines the PCI IDs table for that hardware module */
Alexey Dobriyana3aa1882010-01-07 11:58:11 +00004511static DEFINE_PCI_DEVICE_TABLE(iwl_hw_card_ids) = {
Tomas Winkler4fc22b22008-07-21 18:54:42 +03004512#ifdef CONFIG_IWL4965
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004513 {IWL_PCI_DEVICE(0x4229, PCI_ANY_ID, iwl4965_agn_cfg)},
4514 {IWL_PCI_DEVICE(0x4230, PCI_ANY_ID, iwl4965_agn_cfg)},
Tomas Winkler4fc22b22008-07-21 18:54:42 +03004515#endif /* CONFIG_IWL4965 */
Tomas Winkler5a6a2562008-04-24 11:55:23 -07004516#ifdef CONFIG_IWL5000
Wey-Yi Guyac592572009-11-20 12:05:03 -08004517/* 5100 Series WiFi */
4518 {IWL_PCI_DEVICE(0x4232, 0x1201, iwl5100_agn_cfg)}, /* Mini Card */
4519 {IWL_PCI_DEVICE(0x4232, 0x1301, iwl5100_agn_cfg)}, /* Half Mini Card */
4520 {IWL_PCI_DEVICE(0x4232, 0x1204, iwl5100_agn_cfg)}, /* Mini Card */
4521 {IWL_PCI_DEVICE(0x4232, 0x1304, iwl5100_agn_cfg)}, /* Half Mini Card */
4522 {IWL_PCI_DEVICE(0x4232, 0x1205, iwl5100_bgn_cfg)}, /* Mini Card */
4523 {IWL_PCI_DEVICE(0x4232, 0x1305, iwl5100_bgn_cfg)}, /* Half Mini Card */
4524 {IWL_PCI_DEVICE(0x4232, 0x1206, iwl5100_abg_cfg)}, /* Mini Card */
4525 {IWL_PCI_DEVICE(0x4232, 0x1306, iwl5100_abg_cfg)}, /* Half Mini Card */
4526 {IWL_PCI_DEVICE(0x4232, 0x1221, iwl5100_agn_cfg)}, /* Mini Card */
4527 {IWL_PCI_DEVICE(0x4232, 0x1321, iwl5100_agn_cfg)}, /* Half Mini Card */
4528 {IWL_PCI_DEVICE(0x4232, 0x1224, iwl5100_agn_cfg)}, /* Mini Card */
4529 {IWL_PCI_DEVICE(0x4232, 0x1324, iwl5100_agn_cfg)}, /* Half Mini Card */
4530 {IWL_PCI_DEVICE(0x4232, 0x1225, iwl5100_bgn_cfg)}, /* Mini Card */
4531 {IWL_PCI_DEVICE(0x4232, 0x1325, iwl5100_bgn_cfg)}, /* Half Mini Card */
4532 {IWL_PCI_DEVICE(0x4232, 0x1226, iwl5100_abg_cfg)}, /* Mini Card */
4533 {IWL_PCI_DEVICE(0x4232, 0x1326, iwl5100_abg_cfg)}, /* Half Mini Card */
4534 {IWL_PCI_DEVICE(0x4237, 0x1211, iwl5100_agn_cfg)}, /* Mini Card */
4535 {IWL_PCI_DEVICE(0x4237, 0x1311, iwl5100_agn_cfg)}, /* Half Mini Card */
4536 {IWL_PCI_DEVICE(0x4237, 0x1214, iwl5100_agn_cfg)}, /* Mini Card */
4537 {IWL_PCI_DEVICE(0x4237, 0x1314, iwl5100_agn_cfg)}, /* Half Mini Card */
4538 {IWL_PCI_DEVICE(0x4237, 0x1215, iwl5100_bgn_cfg)}, /* Mini Card */
4539 {IWL_PCI_DEVICE(0x4237, 0x1315, iwl5100_bgn_cfg)}, /* Half Mini Card */
4540 {IWL_PCI_DEVICE(0x4237, 0x1216, iwl5100_abg_cfg)}, /* Mini Card */
4541 {IWL_PCI_DEVICE(0x4237, 0x1316, iwl5100_abg_cfg)}, /* Half Mini Card */
4542
4543/* 5300 Series WiFi */
4544 {IWL_PCI_DEVICE(0x4235, 0x1021, iwl5300_agn_cfg)}, /* Mini Card */
4545 {IWL_PCI_DEVICE(0x4235, 0x1121, iwl5300_agn_cfg)}, /* Half Mini Card */
4546 {IWL_PCI_DEVICE(0x4235, 0x1024, iwl5300_agn_cfg)}, /* Mini Card */
4547 {IWL_PCI_DEVICE(0x4235, 0x1124, iwl5300_agn_cfg)}, /* Half Mini Card */
4548 {IWL_PCI_DEVICE(0x4235, 0x1001, iwl5300_agn_cfg)}, /* Mini Card */
4549 {IWL_PCI_DEVICE(0x4235, 0x1101, iwl5300_agn_cfg)}, /* Half Mini Card */
4550 {IWL_PCI_DEVICE(0x4235, 0x1004, iwl5300_agn_cfg)}, /* Mini Card */
4551 {IWL_PCI_DEVICE(0x4235, 0x1104, iwl5300_agn_cfg)}, /* Half Mini Card */
4552 {IWL_PCI_DEVICE(0x4236, 0x1011, iwl5300_agn_cfg)}, /* Mini Card */
4553 {IWL_PCI_DEVICE(0x4236, 0x1111, iwl5300_agn_cfg)}, /* Half Mini Card */
4554 {IWL_PCI_DEVICE(0x4236, 0x1014, iwl5300_agn_cfg)}, /* Mini Card */
4555 {IWL_PCI_DEVICE(0x4236, 0x1114, iwl5300_agn_cfg)}, /* Half Mini Card */
4556
4557/* 5350 Series WiFi/WiMax */
4558 {IWL_PCI_DEVICE(0x423A, 0x1001, iwl5350_agn_cfg)}, /* Mini Card */
4559 {IWL_PCI_DEVICE(0x423A, 0x1021, iwl5350_agn_cfg)}, /* Mini Card */
4560 {IWL_PCI_DEVICE(0x423B, 0x1011, iwl5350_agn_cfg)}, /* Mini Card */
4561
4562/* 5150 Series Wifi/WiMax */
4563 {IWL_PCI_DEVICE(0x423C, 0x1201, iwl5150_agn_cfg)}, /* Mini Card */
4564 {IWL_PCI_DEVICE(0x423C, 0x1301, iwl5150_agn_cfg)}, /* Half Mini Card */
4565 {IWL_PCI_DEVICE(0x423C, 0x1206, iwl5150_abg_cfg)}, /* Mini Card */
4566 {IWL_PCI_DEVICE(0x423C, 0x1306, iwl5150_abg_cfg)}, /* Half Mini Card */
4567 {IWL_PCI_DEVICE(0x423C, 0x1221, iwl5150_agn_cfg)}, /* Mini Card */
4568 {IWL_PCI_DEVICE(0x423C, 0x1321, iwl5150_agn_cfg)}, /* Half Mini Card */
4569
4570 {IWL_PCI_DEVICE(0x423D, 0x1211, iwl5150_agn_cfg)}, /* Mini Card */
4571 {IWL_PCI_DEVICE(0x423D, 0x1311, iwl5150_agn_cfg)}, /* Half Mini Card */
4572 {IWL_PCI_DEVICE(0x423D, 0x1216, iwl5150_abg_cfg)}, /* Mini Card */
4573 {IWL_PCI_DEVICE(0x423D, 0x1316, iwl5150_abg_cfg)}, /* Half Mini Card */
Wey-Yi Guy5953a622009-09-17 10:43:53 -07004574
4575/* 6x00 Series */
Wey-Yi Guy5953a622009-09-17 10:43:53 -07004576 {IWL_PCI_DEVICE(0x422B, 0x1101, iwl6000_3agn_cfg)},
4577 {IWL_PCI_DEVICE(0x422B, 0x1121, iwl6000_3agn_cfg)},
4578 {IWL_PCI_DEVICE(0x422C, 0x1301, iwl6000i_2agn_cfg)},
4579 {IWL_PCI_DEVICE(0x422C, 0x1306, iwl6000i_2abg_cfg)},
4580 {IWL_PCI_DEVICE(0x422C, 0x1307, iwl6000i_2bg_cfg)},
4581 {IWL_PCI_DEVICE(0x422C, 0x1321, iwl6000i_2agn_cfg)},
4582 {IWL_PCI_DEVICE(0x422C, 0x1326, iwl6000i_2abg_cfg)},
4583 {IWL_PCI_DEVICE(0x4238, 0x1111, iwl6000_3agn_cfg)},
4584 {IWL_PCI_DEVICE(0x4239, 0x1311, iwl6000i_2agn_cfg)},
4585 {IWL_PCI_DEVICE(0x4239, 0x1316, iwl6000i_2abg_cfg)},
Shanyu Zhao4b3e8062010-04-07 18:06:36 -07004586
Shanyu Zhao95b13012010-04-21 11:46:33 -07004587/* 6x00 Series Gen2a */
4588 {IWL_PCI_DEVICE(0x0082, 0x1201, iwl6000g2a_2agn_cfg)},
4589 {IWL_PCI_DEVICE(0x0085, 0x1211, iwl6000g2a_2agn_cfg)},
4590 {IWL_PCI_DEVICE(0x0082, 0x1221, iwl6000g2a_2agn_cfg)},
Shanyu Zhao18089722010-05-06 10:15:21 -07004591 {IWL_PCI_DEVICE(0x0082, 0x1206, iwl6000g2a_2abg_cfg)},
4592 {IWL_PCI_DEVICE(0x0085, 0x1216, iwl6000g2a_2abg_cfg)},
4593 {IWL_PCI_DEVICE(0x0082, 0x1226, iwl6000g2a_2abg_cfg)},
4594 {IWL_PCI_DEVICE(0x0082, 0x1207, iwl6000g2a_2bg_cfg)},
Shanyu Zhao9f6e1ba2010-05-11 15:21:54 -07004595 {IWL_PCI_DEVICE(0x0082, 0x1301, iwl6000g2a_2agn_cfg)},
4596 {IWL_PCI_DEVICE(0x0082, 0x1306, iwl6000g2a_2abg_cfg)},
4597 {IWL_PCI_DEVICE(0x0082, 0x1307, iwl6000g2a_2bg_cfg)},
4598 {IWL_PCI_DEVICE(0x0082, 0x1321, iwl6000g2a_2agn_cfg)},
4599 {IWL_PCI_DEVICE(0x0082, 0x1326, iwl6000g2a_2abg_cfg)},
4600 {IWL_PCI_DEVICE(0x0085, 0x1311, iwl6000g2a_2agn_cfg)},
4601 {IWL_PCI_DEVICE(0x0085, 0x1316, iwl6000g2a_2abg_cfg)},
Shanyu Zhao18089722010-05-06 10:15:21 -07004602
4603/* 6x00 Series Gen2b */
4604 {IWL_PCI_DEVICE(0x008F, 0x5105, iwl6000g2b_bgn_cfg)},
4605 {IWL_PCI_DEVICE(0x0090, 0x5115, iwl6000g2b_bgn_cfg)},
4606 {IWL_PCI_DEVICE(0x008F, 0x5125, iwl6000g2b_bgn_cfg)},
4607 {IWL_PCI_DEVICE(0x008F, 0x5107, iwl6000g2b_bg_cfg)},
4608 {IWL_PCI_DEVICE(0x008F, 0x5201, iwl6000g2b_2agn_cfg)},
4609 {IWL_PCI_DEVICE(0x0090, 0x5211, iwl6000g2b_2agn_cfg)},
4610 {IWL_PCI_DEVICE(0x008F, 0x5221, iwl6000g2b_2agn_cfg)},
4611 {IWL_PCI_DEVICE(0x008F, 0x5206, iwl6000g2b_2abg_cfg)},
4612 {IWL_PCI_DEVICE(0x0090, 0x5216, iwl6000g2b_2abg_cfg)},
4613 {IWL_PCI_DEVICE(0x008F, 0x5226, iwl6000g2b_2abg_cfg)},
4614 {IWL_PCI_DEVICE(0x008F, 0x5207, iwl6000g2b_2bg_cfg)},
Shanyu Zhao9f6e1ba2010-05-11 15:21:54 -07004615 {IWL_PCI_DEVICE(0x008A, 0x5301, iwl6000g2b_bgn_cfg)},
4616 {IWL_PCI_DEVICE(0x008A, 0x5305, iwl6000g2b_bgn_cfg)},
4617 {IWL_PCI_DEVICE(0x008A, 0x5307, iwl6000g2b_bg_cfg)},
4618 {IWL_PCI_DEVICE(0x008A, 0x5321, iwl6000g2b_bgn_cfg)},
4619 {IWL_PCI_DEVICE(0x008A, 0x5325, iwl6000g2b_bgn_cfg)},
4620 {IWL_PCI_DEVICE(0x008B, 0x5311, iwl6000g2b_bgn_cfg)},
4621 {IWL_PCI_DEVICE(0x008B, 0x5315, iwl6000g2b_bgn_cfg)},
4622 {IWL_PCI_DEVICE(0x0090, 0x5211, iwl6000g2b_2agn_cfg)},
4623 {IWL_PCI_DEVICE(0x0090, 0x5215, iwl6000g2b_2bgn_cfg)},
4624 {IWL_PCI_DEVICE(0x0090, 0x5216, iwl6000g2b_2abg_cfg)},
4625 {IWL_PCI_DEVICE(0x0091, 0x5201, iwl6000g2b_2agn_cfg)},
4626 {IWL_PCI_DEVICE(0x0091, 0x5205, iwl6000g2b_2bgn_cfg)},
4627 {IWL_PCI_DEVICE(0x0091, 0x5206, iwl6000g2b_2abg_cfg)},
4628 {IWL_PCI_DEVICE(0x0091, 0x5207, iwl6000g2b_2bg_cfg)},
4629 {IWL_PCI_DEVICE(0x0091, 0x5221, iwl6000g2b_2agn_cfg)},
4630 {IWL_PCI_DEVICE(0x0091, 0x5225, iwl6000g2b_2bgn_cfg)},
4631 {IWL_PCI_DEVICE(0x0091, 0x5226, iwl6000g2b_2abg_cfg)},
Wey-Yi Guy5953a622009-09-17 10:43:53 -07004632
4633/* 6x50 WiFi/WiMax Series */
Wey-Yi Guy5953a622009-09-17 10:43:53 -07004634 {IWL_PCI_DEVICE(0x0087, 0x1301, iwl6050_2agn_cfg)},
4635 {IWL_PCI_DEVICE(0x0087, 0x1306, iwl6050_2abg_cfg)},
4636 {IWL_PCI_DEVICE(0x0087, 0x1321, iwl6050_2agn_cfg)},
4637 {IWL_PCI_DEVICE(0x0087, 0x1326, iwl6050_2abg_cfg)},
Wey-Yi Guy5953a622009-09-17 10:43:53 -07004638 {IWL_PCI_DEVICE(0x0089, 0x1311, iwl6050_2agn_cfg)},
4639 {IWL_PCI_DEVICE(0x0089, 0x1316, iwl6050_2abg_cfg)},
4640
Shanyu Zhao03264332010-06-29 17:27:27 -07004641/* 6x50 WiFi/WiMax Series Gen2 */
4642 {IWL_PCI_DEVICE(0x0885, 0x1305, iwl6050g2_bgn_cfg)},
4643 {IWL_PCI_DEVICE(0x0885, 0x1306, iwl6050g2_bgn_cfg)},
4644 {IWL_PCI_DEVICE(0x0885, 0x1325, iwl6050g2_bgn_cfg)},
4645 {IWL_PCI_DEVICE(0x0885, 0x1326, iwl6050g2_bgn_cfg)},
4646 {IWL_PCI_DEVICE(0x0886, 0x1315, iwl6050g2_bgn_cfg)},
4647 {IWL_PCI_DEVICE(0x0886, 0x1316, iwl6050g2_bgn_cfg)},
4648
Jay Sternberg77dcb6a2009-03-06 13:52:55 -08004649/* 1000 Series WiFi */
Wey-Yi Guy4bd0914f2009-09-17 10:43:52 -07004650 {IWL_PCI_DEVICE(0x0083, 0x1205, iwl1000_bgn_cfg)},
4651 {IWL_PCI_DEVICE(0x0083, 0x1305, iwl1000_bgn_cfg)},
4652 {IWL_PCI_DEVICE(0x0083, 0x1225, iwl1000_bgn_cfg)},
4653 {IWL_PCI_DEVICE(0x0083, 0x1325, iwl1000_bgn_cfg)},
4654 {IWL_PCI_DEVICE(0x0084, 0x1215, iwl1000_bgn_cfg)},
4655 {IWL_PCI_DEVICE(0x0084, 0x1315, iwl1000_bgn_cfg)},
4656 {IWL_PCI_DEVICE(0x0083, 0x1206, iwl1000_bg_cfg)},
4657 {IWL_PCI_DEVICE(0x0083, 0x1306, iwl1000_bg_cfg)},
4658 {IWL_PCI_DEVICE(0x0083, 0x1226, iwl1000_bg_cfg)},
4659 {IWL_PCI_DEVICE(0x0083, 0x1326, iwl1000_bg_cfg)},
4660 {IWL_PCI_DEVICE(0x0084, 0x1216, iwl1000_bg_cfg)},
4661 {IWL_PCI_DEVICE(0x0084, 0x1316, iwl1000_bg_cfg)},
Tomas Winkler5a6a2562008-04-24 11:55:23 -07004662#endif /* CONFIG_IWL5000 */
Tomas Winkler7100e922008-12-01 16:32:18 -08004663
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004664 {0}
4665};
4666MODULE_DEVICE_TABLE(pci, iwl_hw_card_ids);
4667
4668static struct pci_driver iwl_driver = {
Zhu Yib481de92007-09-25 17:54:57 -07004669 .name = DRV_NAME,
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004670 .id_table = iwl_hw_card_ids,
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004671 .probe = iwl_pci_probe,
4672 .remove = __devexit_p(iwl_pci_remove),
Zhu Yib481de92007-09-25 17:54:57 -07004673#ifdef CONFIG_PM
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004674 .suspend = iwl_pci_suspend,
4675 .resume = iwl_pci_resume,
Zhu Yib481de92007-09-25 17:54:57 -07004676#endif
4677};
4678
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004679static int __init iwl_init(void)
Zhu Yib481de92007-09-25 17:54:57 -07004680{
4681
4682 int ret;
Joe Perchesc96c31e2010-07-26 14:39:58 -07004683 pr_info(DRV_DESCRIPTION ", " DRV_VERSION "\n");
4684 pr_info(DRV_COPYRIGHT "\n");
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004685
Tomas Winklere227cea2008-07-18 13:53:05 +08004686 ret = iwlagn_rate_control_register();
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004687 if (ret) {
Joe Perchesc96c31e2010-07-26 14:39:58 -07004688 pr_err("Unable to register rate control algorithm: %d\n", ret);
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004689 return ret;
4690 }
4691
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004692 ret = pci_register_driver(&iwl_driver);
Zhu Yib481de92007-09-25 17:54:57 -07004693 if (ret) {
Joe Perchesc96c31e2010-07-26 14:39:58 -07004694 pr_err("Unable to initialize PCI module\n");
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004695 goto error_register;
Zhu Yib481de92007-09-25 17:54:57 -07004696 }
Zhu Yib481de92007-09-25 17:54:57 -07004697
4698 return ret;
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004699
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004700error_register:
Tomas Winklere227cea2008-07-18 13:53:05 +08004701 iwlagn_rate_control_unregister();
Reinette Chatre897e1cf2008-03-28 16:21:09 -07004702 return ret;
Zhu Yib481de92007-09-25 17:54:57 -07004703}
4704
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004705static void __exit iwl_exit(void)
Zhu Yib481de92007-09-25 17:54:57 -07004706{
Ron Rindjunskyfed90172008-04-15 16:01:41 -07004707 pci_unregister_driver(&iwl_driver);
Tomas Winklere227cea2008-07-18 13:53:05 +08004708 iwlagn_rate_control_unregister();
Zhu Yib481de92007-09-25 17:54:57 -07004709}
4710
Emmanuel Grumbach5b9f8cd2008-10-29 14:05:46 -07004711module_exit(iwl_exit);
4712module_init(iwl_init);
Reinette Chatrea562a9d2009-07-17 09:30:24 -07004713
4714#ifdef CONFIG_IWLWIFI_DEBUG
Wey-Yi Guy4e30cb62009-09-17 10:43:47 -07004715module_param_named(debug50, iwl_debug_level, uint, S_IRUGO);
Reinette Chatrea562a9d2009-07-17 09:30:24 -07004716MODULE_PARM_DESC(debug50, "50XX debug output mask (deprecated)");
Wey-Yi Guy4e30cb62009-09-17 10:43:47 -07004717module_param_named(debug, iwl_debug_level, uint, S_IRUGO | S_IWUSR);
Reinette Chatrea562a9d2009-07-17 09:30:24 -07004718MODULE_PARM_DESC(debug, "debug output mask");
4719#endif
4720
Wey-Yi Guy2b068612010-03-22 09:17:39 -07004721module_param_named(swcrypto50, iwlagn_mod_params.sw_crypto, bool, S_IRUGO);
4722MODULE_PARM_DESC(swcrypto50,
4723 "using crypto in software (default 0 [hardware]) (deprecated)");
4724module_param_named(swcrypto, iwlagn_mod_params.sw_crypto, int, S_IRUGO);
4725MODULE_PARM_DESC(swcrypto, "using crypto in software (default 0 [hardware])");
4726module_param_named(queues_num50,
4727 iwlagn_mod_params.num_of_queues, int, S_IRUGO);
4728MODULE_PARM_DESC(queues_num50,
4729 "number of hw queues in 50xx series (deprecated)");
4730module_param_named(queues_num, iwlagn_mod_params.num_of_queues, int, S_IRUGO);
4731MODULE_PARM_DESC(queues_num, "number of hw queues.");
4732module_param_named(11n_disable50, iwlagn_mod_params.disable_11n, int, S_IRUGO);
4733MODULE_PARM_DESC(11n_disable50, "disable 50XX 11n functionality (deprecated)");
4734module_param_named(11n_disable, iwlagn_mod_params.disable_11n, int, S_IRUGO);
4735MODULE_PARM_DESC(11n_disable, "disable 11n functionality");
4736module_param_named(amsdu_size_8K50, iwlagn_mod_params.amsdu_size_8K,
4737 int, S_IRUGO);
4738MODULE_PARM_DESC(amsdu_size_8K50,
4739 "enable 8K amsdu size in 50XX series (deprecated)");
4740module_param_named(amsdu_size_8K, iwlagn_mod_params.amsdu_size_8K,
4741 int, S_IRUGO);
4742MODULE_PARM_DESC(amsdu_size_8K, "enable 8K amsdu size");
4743module_param_named(fw_restart50, iwlagn_mod_params.restart_fw, int, S_IRUGO);
4744MODULE_PARM_DESC(fw_restart50,
4745 "restart firmware in case of error (deprecated)");
4746module_param_named(fw_restart, iwlagn_mod_params.restart_fw, int, S_IRUGO);
4747MODULE_PARM_DESC(fw_restart, "restart firmware in case of error");
4748module_param_named(
4749 disable_hw_scan, iwlagn_mod_params.disable_hw_scan, int, S_IRUGO);
4750MODULE_PARM_DESC(disable_hw_scan, "disable hardware scanning (default 0)");
Johannes Bergdd7a2502010-04-28 23:33:10 -07004751
4752module_param_named(ucode_alternative, iwlagn_wanted_ucode_alternative, int,
4753 S_IRUGO);
4754MODULE_PARM_DESC(ucode_alternative,
4755 "specify ucode alternative to use from ucode file");
Wey-Yi Guybee008b2010-08-23 07:57:04 -07004756
4757module_param_named(antenna_coupling, iwlagn_ant_coupling, int, S_IRUGO);
4758MODULE_PARM_DESC(antenna_coupling,
4759 "specify antenna coupling in dB (defualt: 0 dB)");
Wey-Yi Guyf37837c2010-08-23 07:57:12 -07004760
4761module_param_named(bt_ch_announce, iwlagn_bt_ch_announce, bool, S_IRUGO);
4762MODULE_PARM_DESC(bt_ch_announce,
4763 "Enable BT channel announcement mode (default: enable)");