iwl-agn.c 109.2 KB
Newer Older
Z
Zhu Yi 已提交
1 2
/******************************************************************************
 *
3
 * Copyright(c) 2003 - 2010 Intel Corporation. All rights reserved.
Z
Zhu Yi 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
 *
 * Portions of this file are derived from the ipw3945 project, as well
 * as portions of the ieee80211 subsystem header files.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
25
 *  Intel Linux Wireless <ilw@linux.intel.com>
Z
Zhu Yi 已提交
26 27 28 29 30 31 32 33 34 35
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 *****************************************************************************/

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/dma-mapping.h>
#include <linux/delay.h>
36
#include <linux/sched.h>
Z
Zhu Yi 已提交
37 38 39 40 41 42 43 44 45 46 47
#include <linux/skbuff.h>
#include <linux/netdevice.h>
#include <linux/wireless.h>
#include <linux/firmware.h>
#include <linux/etherdevice.h>
#include <linux/if_arp.h>

#include <net/mac80211.h>

#include <asm/div64.h>

48 49
#define DRV_NAME        "iwlagn"

A
Assaf Krauss 已提交
50
#include "iwl-eeprom.h"
51
#include "iwl-dev.h"
52
#include "iwl-core.h"
53
#include "iwl-io.h"
Z
Zhu Yi 已提交
54
#include "iwl-helpers.h"
55
#include "iwl-sta.h"
56
#include "iwl-calib.h"
57
#include "iwl-agn.h"
Z
Zhu Yi 已提交
58

59

Z
Zhu Yi 已提交
60 61 62 63 64 65 66 67 68
/******************************************************************************
 *
 * module boiler plate
 *
 ******************************************************************************/

/*
 * module name, copyright, version, etc.
 */
69
#define DRV_DESCRIPTION	"Intel(R) Wireless WiFi Link AGN driver for Linux"
Z
Zhu Yi 已提交
70

71
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
72 73 74 75 76
#define VD "d"
#else
#define VD
#endif

77
#define DRV_VERSION     IWLWIFI_VERSION VD
Z
Zhu Yi 已提交
78 79 80 81


MODULE_DESCRIPTION(DRV_DESCRIPTION);
MODULE_VERSION(DRV_VERSION);
82
MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
Z
Zhu Yi 已提交
83
MODULE_LICENSE("GPL");
T
Tomas Winkler 已提交
84
MODULE_ALIAS("iwl4965");
Z
Zhu Yi 已提交
85 86

/*************** STATION TABLE MANAGEMENT ****
87
 * mac80211 should be examined to determine if sta_info is duplicating
Z
Zhu Yi 已提交
88 89 90 91 92 93
 * the functionality provided here
 */

/**************************************************************/

/**
94
 * iwl_commit_rxon - commit staging_rxon to hardware
Z
Zhu Yi 已提交
95
 *
96
 * The RXON command in staging_rxon is committed to the hardware and
Z
Zhu Yi 已提交
97 98 99 100
 * the active_rxon structure is updated with the new data.  This
 * function correctly transitions out of the RXON_ASSOC_MSK state if
 * a HW tune is required based on the RXON structure changes.
 */
A
Abhijeet Kolekar 已提交
101
int iwl_commit_rxon(struct iwl_priv *priv)
Z
Zhu Yi 已提交
102 103
{
	/* cast away the const for active_rxon in this function */
G
Gregory Greenman 已提交
104
	struct iwl_rxon_cmd *active_rxon = (void *)&priv->active_rxon;
105 106 107
	int ret;
	bool new_assoc =
		!!(priv->staging_rxon.filter_flags & RXON_FILTER_ASSOC_MSK);
Z
Zhu Yi 已提交
108

109
	if (!iwl_is_alive(priv))
110
		return -EBUSY;
Z
Zhu Yi 已提交
111 112 113 114

	/* always get timestamp with Rx frame */
	priv->staging_rxon.flags |= RXON_FLG_TSF2HOST_MSK;

115
	ret = iwl_check_rxon_cmd(priv);
116
	if (ret) {
117
		IWL_ERR(priv, "Invalid RXON configuration.  Not committing.\n");
Z
Zhu Yi 已提交
118 119 120
		return -EINVAL;
	}

W
Wey-Yi Guy 已提交
121 122 123 124 125 126 127 128 129 130 131
	/*
	 * receive commit_rxon request
	 * abort any previous channel switch if still in process
	 */
	if (priv->switch_rxon.switch_in_progress &&
	    (priv->switch_rxon.channel != priv->staging_rxon.channel)) {
		IWL_DEBUG_11H(priv, "abort channel switch on %d\n",
		      le16_to_cpu(priv->switch_rxon.channel));
		priv->switch_rxon.switch_in_progress = false;
	}

Z
Zhu Yi 已提交
132
	/* If we don't need to send a full RXON, we can use
133
	 * iwl_rxon_assoc_cmd which is used to reconfigure filter
Z
Zhu Yi 已提交
134
	 * and other flags for the current radio configuration. */
135
	if (!iwl_full_rxon_required(priv)) {
136 137
		ret = iwl_send_rxon_assoc(priv);
		if (ret) {
138
			IWL_ERR(priv, "Error setting RXON_ASSOC (%d)\n", ret);
139
			return ret;
Z
Zhu Yi 已提交
140 141 142
		}

		memcpy(active_rxon, &priv->staging_rxon, sizeof(*active_rxon));
143
		iwl_print_rx_config_cmd(priv);
Z
Zhu Yi 已提交
144 145 146 147 148 149 150
		return 0;
	}

	/* If we are currently associated and the new config requires
	 * an RXON_ASSOC and the new config wants the associated mask enabled,
	 * we must clear the associated from the active configuration
	 * before we apply the new config */
151
	if (iwl_is_associated(priv) && new_assoc) {
152
		IWL_DEBUG_INFO(priv, "Toggling associated bit on current RXON\n");
Z
Zhu Yi 已提交
153 154
		active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;

155
		ret = iwl_send_cmd_pdu(priv, REPLY_RXON,
G
Gregory Greenman 已提交
156
				      sizeof(struct iwl_rxon_cmd),
Z
Zhu Yi 已提交
157 158 159 160
				      &priv->active_rxon);

		/* If the mask clearing failed then we set
		 * active_rxon back to what it was previously */
161
		if (ret) {
Z
Zhu Yi 已提交
162
			active_rxon->filter_flags |= RXON_FILTER_ASSOC_MSK;
163
			IWL_ERR(priv, "Error clearing ASSOC_MSK (%d)\n", ret);
164
			return ret;
Z
Zhu Yi 已提交
165
		}
166 167
		iwl_clear_ucode_stations(priv, false);
		iwl_restore_stations(priv);
Z
Zhu Yi 已提交
168 169
	}

170
	IWL_DEBUG_INFO(priv, "Sending RXON\n"
Z
Zhu Yi 已提交
171 172
		       "* with%s RXON_FILTER_ASSOC_MSK\n"
		       "* channel = %d\n"
J
Johannes Berg 已提交
173
		       "* bssid = %pM\n",
174
		       (new_assoc ? "" : "out"),
Z
Zhu Yi 已提交
175
		       le16_to_cpu(priv->staging_rxon.channel),
J
Johannes Berg 已提交
176
		       priv->staging_rxon.bssid_addr);
Z
Zhu Yi 已提交
177

178
	iwl_set_rxon_hwcrypto(priv, !priv->cfg->mod_params->sw_crypto);
179 180

	/* Apply the new configuration
181 182
	 * RXON unassoc clears the station table in uCode so restoration of
	 * stations is needed after it (the RXON command) completes
183 184 185
	 */
	if (!new_assoc) {
		ret = iwl_send_cmd_pdu(priv, REPLY_RXON,
G
Gregory Greenman 已提交
186
			      sizeof(struct iwl_rxon_cmd), &priv->staging_rxon);
187
		if (ret) {
188
			IWL_ERR(priv, "Error setting new RXON (%d)\n", ret);
189 190
			return ret;
		}
191
		IWL_DEBUG_INFO(priv, "Return from !new_assoc RXON. \n");
192
		memcpy(active_rxon, &priv->staging_rxon, sizeof(*active_rxon));
193 194
		iwl_clear_ucode_stations(priv, false);
		iwl_restore_stations(priv);
Z
Zhu Yi 已提交
195 196
	}

J
Johannes Berg 已提交
197
	priv->start_calib = 0;
198
	if (new_assoc) {
199 200 201 202 203 204 205
		/*
		 * allow CTS-to-self if possible for new association.
		 * this is relevant only for 5000 series and up,
		 * but will not damage 4965
		 */
		priv->staging_rxon.flags |= RXON_FLG_SELF_CTS_EN;

206 207 208 209 210 211
		/* Apply the new configuration
		 * RXON assoc doesn't clear the station table in uCode,
		 */
		ret = iwl_send_cmd_pdu(priv, REPLY_RXON,
			      sizeof(struct iwl_rxon_cmd), &priv->staging_rxon);
		if (ret) {
212
			IWL_ERR(priv, "Error setting new RXON (%d)\n", ret);
213 214 215
			return ret;
		}
		memcpy(active_rxon, &priv->staging_rxon, sizeof(*active_rxon));
Z
Zhu Yi 已提交
216
	}
217
	iwl_print_rx_config_cmd(priv);
Z
Zhu Yi 已提交
218

219 220 221 222 223 224
	iwl_init_sensitivity(priv);

	/* If we issue a new RXON command which required a tune then we must
	 * send a new TXPOWER command or we won't be able to Tx any frames */
	ret = iwl_set_tx_power(priv, priv->tx_power_user_lmt, true);
	if (ret) {
225
		IWL_ERR(priv, "Error sending TX power (%d)\n", ret);
226 227 228
		return ret;
	}

Z
Zhu Yi 已提交
229 230 231
	return 0;
}

232
void iwl_update_chain_flags(struct iwl_priv *priv)
M
Mohamed Abbas 已提交
233 234
{

235 236
	if (priv->cfg->ops->hcmd->set_rxon_chain)
		priv->cfg->ops->hcmd->set_rxon_chain(priv);
A
Abhijeet Kolekar 已提交
237
	iwlcore_commit_rxon(priv);
M
Mohamed Abbas 已提交
238 239
}

240
static void iwl_clear_free_frames(struct iwl_priv *priv)
Z
Zhu Yi 已提交
241 242 243
{
	struct list_head *element;

244
	IWL_DEBUG_INFO(priv, "%d frames on pre-allocated heap on clear.\n",
Z
Zhu Yi 已提交
245 246 247 248 249
		       priv->frames_count);

	while (!list_empty(&priv->free_frames)) {
		element = priv->free_frames.next;
		list_del(element);
250
		kfree(list_entry(element, struct iwl_frame, list));
Z
Zhu Yi 已提交
251 252 253 254
		priv->frames_count--;
	}

	if (priv->frames_count) {
255
		IWL_WARN(priv, "%d frames still in use.  Did we lose one?\n",
Z
Zhu Yi 已提交
256 257 258 259 260
			    priv->frames_count);
		priv->frames_count = 0;
	}
}

261
static struct iwl_frame *iwl_get_free_frame(struct iwl_priv *priv)
Z
Zhu Yi 已提交
262
{
263
	struct iwl_frame *frame;
Z
Zhu Yi 已提交
264 265 266 267
	struct list_head *element;
	if (list_empty(&priv->free_frames)) {
		frame = kzalloc(sizeof(*frame), GFP_KERNEL);
		if (!frame) {
268
			IWL_ERR(priv, "Could not allocate frame!\n");
Z
Zhu Yi 已提交
269 270 271 272 273 274 275 276 277
			return NULL;
		}

		priv->frames_count++;
		return frame;
	}

	element = priv->free_frames.next;
	list_del(element);
278
	return list_entry(element, struct iwl_frame, list);
Z
Zhu Yi 已提交
279 280
}

281
static void iwl_free_frame(struct iwl_priv *priv, struct iwl_frame *frame)
Z
Zhu Yi 已提交
282 283 284 285 286
{
	memset(frame, 0, sizeof(*frame));
	list_add(&frame->list, &priv->free_frames);
}

287
static u32 iwl_fill_beacon_frame(struct iwl_priv *priv,
288
					  struct ieee80211_hdr *hdr,
289
					  int left)
Z
Zhu Yi 已提交
290
{
291
	if (!iwl_is_associated(priv) || !priv->ibss_beacon ||
292 293
	    ((priv->iw_mode != NL80211_IFTYPE_ADHOC) &&
	     (priv->iw_mode != NL80211_IFTYPE_AP)))
Z
Zhu Yi 已提交
294 295 296 297 298 299 300 301 302 303
		return 0;

	if (priv->ibss_beacon->len > left)
		return 0;

	memcpy(hdr, priv->ibss_beacon->data, priv->ibss_beacon->len);

	return priv->ibss_beacon->len;
}

304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330
/* Parse the beacon frame to find the TIM element and set tim_idx & tim_size */
static void iwl_set_beacon_tim(struct iwl_priv *priv,
		struct iwl_tx_beacon_cmd *tx_beacon_cmd,
		u8 *beacon, u32 frame_size)
{
	u16 tim_idx;
	struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)beacon;

	/*
	 * The index is relative to frame start but we start looking at the
	 * variable-length part of the beacon.
	 */
	tim_idx = mgmt->u.beacon.variable - beacon;

	/* Parse variable-length elements of beacon to find WLAN_EID_TIM */
	while ((tim_idx < (frame_size - 2)) &&
			(beacon[tim_idx] != WLAN_EID_TIM))
		tim_idx += beacon[tim_idx+1] + 2;

	/* If TIM field was found, set variables */
	if ((tim_idx < (frame_size - 1)) && (beacon[tim_idx] == WLAN_EID_TIM)) {
		tx_beacon_cmd->tim_idx = cpu_to_le16(tim_idx);
		tx_beacon_cmd->tim_size = beacon[tim_idx+1];
	} else
		IWL_WARN(priv, "Unable to find TIM Element in beacon\n");
}

331
static unsigned int iwl_hw_get_beacon_cmd(struct iwl_priv *priv,
332
				       struct iwl_frame *frame)
333 334
{
	struct iwl_tx_beacon_cmd *tx_beacon_cmd;
335 336 337 338 339 340 341
	u32 frame_size;
	u32 rate_flags;
	u32 rate;
	/*
	 * We have to set up the TX command, the TX Beacon command, and the
	 * beacon contents.
	 */
342

343
	/* Initialize memory */
344 345 346
	tx_beacon_cmd = &frame->u.beacon;
	memset(tx_beacon_cmd, 0, sizeof(*tx_beacon_cmd));

347
	/* Set up TX beacon contents */
348 349
	frame_size = iwl_fill_beacon_frame(priv, tx_beacon_cmd->frame,
				sizeof(frame->u) - sizeof(*tx_beacon_cmd));
350 351
	if (WARN_ON_ONCE(frame_size > MAX_MPDU_SIZE))
		return 0;
352

353
	/* Set up TX command fields */
354
	tx_beacon_cmd->tx.len = cpu_to_le16((u16)frame_size);
355 356 357 358
	tx_beacon_cmd->tx.sta_id = priv->hw_params.bcast_sta_id;
	tx_beacon_cmd->tx.stop_time.life_time = TX_CMD_LIFE_TIME_INFINITE;
	tx_beacon_cmd->tx.tx_flags = TX_CMD_FLG_SEQ_CTL_MSK |
		TX_CMD_FLG_TSF_MSK | TX_CMD_FLG_STA_RATE_MSK;
359

360 361 362
	/* Set up TX beacon command fields */
	iwl_set_beacon_tim(priv, tx_beacon_cmd, (u8 *)tx_beacon_cmd->frame,
			frame_size);
363

364 365 366 367 368 369 370 371
	/* Set up packet rate and flags */
	rate = iwl_rate_get_lowest_plcp(priv);
	priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant);
	rate_flags = iwl_ant_idx_to_flags(priv->mgmt_tx_ant);
	if ((rate >= IWL_FIRST_CCK_RATE) && (rate <= IWL_LAST_CCK_RATE))
		rate_flags |= RATE_MCS_CCK_MSK;
	tx_beacon_cmd->tx.rate_n_flags = iwl_hw_set_rate_n_flags(rate,
			rate_flags);
372 373 374

	return sizeof(*tx_beacon_cmd) + frame_size;
}
375
static int iwl_send_beacon_cmd(struct iwl_priv *priv)
Z
Zhu Yi 已提交
376
{
377
	struct iwl_frame *frame;
Z
Zhu Yi 已提交
378 379 380
	unsigned int frame_size;
	int rc;

381
	frame = iwl_get_free_frame(priv);
Z
Zhu Yi 已提交
382
	if (!frame) {
383
		IWL_ERR(priv, "Could not obtain free frame buffer for beacon "
Z
Zhu Yi 已提交
384 385 386 387
			  "command.\n");
		return -ENOMEM;
	}

388 389 390 391 392 393
	frame_size = iwl_hw_get_beacon_cmd(priv, frame);
	if (!frame_size) {
		IWL_ERR(priv, "Error configuring the beacon command\n");
		iwl_free_frame(priv, frame);
		return -EINVAL;
	}
Z
Zhu Yi 已提交
394

395
	rc = iwl_send_cmd_pdu(priv, REPLY_TX_BEACON, frame_size,
Z
Zhu Yi 已提交
396 397
			      &frame->u.cmd[0]);

398
	iwl_free_frame(priv, frame);
Z
Zhu Yi 已提交
399 400 401 402

	return rc;
}

403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
static inline dma_addr_t iwl_tfd_tb_get_addr(struct iwl_tfd *tfd, u8 idx)
{
	struct iwl_tfd_tb *tb = &tfd->tbs[idx];

	dma_addr_t addr = get_unaligned_le32(&tb->lo);
	if (sizeof(dma_addr_t) > sizeof(u32))
		addr |=
		((dma_addr_t)(le16_to_cpu(tb->hi_n_len) & 0xF) << 16) << 16;

	return addr;
}

static inline u16 iwl_tfd_tb_get_len(struct iwl_tfd *tfd, u8 idx)
{
	struct iwl_tfd_tb *tb = &tfd->tbs[idx];

	return le16_to_cpu(tb->hi_n_len) >> 4;
}

static inline void iwl_tfd_set_tb(struct iwl_tfd *tfd, u8 idx,
				  dma_addr_t addr, u16 len)
{
	struct iwl_tfd_tb *tb = &tfd->tbs[idx];
	u16 hi_n_len = len << 4;

	put_unaligned_le32(addr, &tb->lo);
	if (sizeof(dma_addr_t) > sizeof(u32))
		hi_n_len |= ((addr >> 16) >> 16) & 0xF;

	tb->hi_n_len = cpu_to_le16(hi_n_len);

	tfd->num_tbs = idx + 1;
}

static inline u8 iwl_tfd_get_num_tbs(struct iwl_tfd *tfd)
{
	return tfd->num_tbs & 0x1f;
}

/**
 * iwl_hw_txq_free_tfd - Free all chunks referenced by TFD [txq->q.read_ptr]
 * @priv - driver private data
 * @txq - tx queue
 *
 * Does NOT advance any TFD circular buffer read/write indexes
 * Does NOT free the TFD itself (which is within circular buffer)
 */
void iwl_hw_txq_free_tfd(struct iwl_priv *priv, struct iwl_tx_queue *txq)
{
452
	struct iwl_tfd *tfd_tmp = (struct iwl_tfd *)txq->tfds;
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472
	struct iwl_tfd *tfd;
	struct pci_dev *dev = priv->pci_dev;
	int index = txq->q.read_ptr;
	int i;
	int num_tbs;

	tfd = &tfd_tmp[index];

	/* Sanity check on number of chunks */
	num_tbs = iwl_tfd_get_num_tbs(tfd);

	if (num_tbs >= IWL_NUM_OF_TBS) {
		IWL_ERR(priv, "Too many chunks: %i\n", num_tbs);
		/* @todo issue fatal error, it is quite serious situation */
		return;
	}

	/* Unmap tx_cmd */
	if (num_tbs)
		pci_unmap_single(dev,
J
Johannes Berg 已提交
473 474
				pci_unmap_addr(&txq->meta[index], mapping),
				pci_unmap_len(&txq->meta[index], len),
475
				PCI_DMA_BIDIRECTIONAL);
476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494

	/* Unmap chunks, if any. */
	for (i = 1; i < num_tbs; i++) {
		pci_unmap_single(dev, iwl_tfd_tb_get_addr(tfd, i),
				iwl_tfd_tb_get_len(tfd, i), PCI_DMA_TODEVICE);

		if (txq->txb) {
			dev_kfree_skb(txq->txb[txq->q.read_ptr].skb[i - 1]);
			txq->txb[txq->q.read_ptr].skb[i - 1] = NULL;
		}
	}
}

int iwl_hw_txq_attach_buf_to_tfd(struct iwl_priv *priv,
				 struct iwl_tx_queue *txq,
				 dma_addr_t addr, u16 len,
				 u8 reset, u8 pad)
{
	struct iwl_queue *q;
495
	struct iwl_tfd *tfd, *tfd_tmp;
496 497 498
	u32 num_tbs;

	q = &txq->q;
499 500
	tfd_tmp = (struct iwl_tfd *)txq->tfds;
	tfd = &tfd_tmp[q->write_ptr];
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523

	if (reset)
		memset(tfd, 0, sizeof(*tfd));

	num_tbs = iwl_tfd_get_num_tbs(tfd);

	/* Each TFD can point to a maximum 20 Tx buffers */
	if (num_tbs >= IWL_NUM_OF_TBS) {
		IWL_ERR(priv, "Error can not send more than %d chunks\n",
			  IWL_NUM_OF_TBS);
		return -EINVAL;
	}

	BUG_ON(addr & ~DMA_BIT_MASK(36));
	if (unlikely(addr & ~IWL_TX_DMA_MASK))
		IWL_ERR(priv, "Unaligned address = %llx\n",
			  (unsigned long long)addr);

	iwl_tfd_set_tb(tfd, num_tbs, addr, len);

	return 0;
}

524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542
/*
 * Tell nic where to find circular buffer of Tx Frame Descriptors for
 * given Tx queue, and enable the DMA channel used for that queue.
 *
 * 4965 supports up to 16 Tx queues in DRAM, mapped to up to 8 Tx DMA
 * channels supported in hardware.
 */
int iwl_hw_tx_queue_init(struct iwl_priv *priv,
			 struct iwl_tx_queue *txq)
{
	int txq_id = txq->q.id;

	/* Circular buffer (TFD queue in DRAM) physical base address */
	iwl_write_direct32(priv, FH_MEM_CBBC_QUEUE(txq_id),
			     txq->q.dma_addr >> 8);

	return 0;
}

Z
Zhu Yi 已提交
543 544 545 546 547
/******************************************************************************
 *
 * Generic RX handler implementations
 *
 ******************************************************************************/
548 549
static void iwl_rx_reply_alive(struct iwl_priv *priv,
				struct iwl_rx_mem_buffer *rxb)
Z
Zhu Yi 已提交
550
{
Z
Zhu Yi 已提交
551
	struct iwl_rx_packet *pkt = rxb_addr(rxb);
552
	struct iwl_alive_resp *palive;
Z
Zhu Yi 已提交
553 554 555 556
	struct delayed_work *pwork;

	palive = &pkt->u.alive_frame;

557
	IWL_DEBUG_INFO(priv, "Alive ucode status 0x%08X revision "
Z
Zhu Yi 已提交
558 559 560 561 562
		       "0x%01X 0x%01X\n",
		       palive->is_valid, palive->ver_type,
		       palive->ver_subtype);

	if (palive->ver_subtype == INITIALIZE_SUBTYPE) {
563
		IWL_DEBUG_INFO(priv, "Initialization Alive received.\n");
Z
Zhu Yi 已提交
564 565
		memcpy(&priv->card_alive_init,
		       &pkt->u.alive_frame,
566
		       sizeof(struct iwl_init_alive_resp));
Z
Zhu Yi 已提交
567 568
		pwork = &priv->init_alive_start;
	} else {
569
		IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
Z
Zhu Yi 已提交
570
		memcpy(&priv->card_alive, &pkt->u.alive_frame,
571
		       sizeof(struct iwl_alive_resp));
Z
Zhu Yi 已提交
572 573 574 575 576 577 578 579 580
		pwork = &priv->alive_start;
	}

	/* We delay the ALIVE response by 5ms to
	 * give the HW RF Kill time to activate... */
	if (palive->is_valid == UCODE_VALID_OK)
		queue_delayed_work(priv->workqueue, pwork,
				   msecs_to_jiffies(5));
	else
581
		IWL_WARN(priv, "uCode did not respond OK.\n");
Z
Zhu Yi 已提交
582 583
}

584
static void iwl_bg_beacon_update(struct work_struct *work)
Z
Zhu Yi 已提交
585
{
586 587
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, beacon_update);
Z
Zhu Yi 已提交
588 589 590
	struct sk_buff *beacon;

	/* Pull updated AP beacon from mac80211. will fail if not in AP mode */
591
	beacon = ieee80211_beacon_get(priv->hw, priv->vif);
Z
Zhu Yi 已提交
592 593

	if (!beacon) {
594
		IWL_ERR(priv, "update beacon failed\n");
Z
Zhu Yi 已提交
595 596 597 598 599 600 601 602 603 604 605
		return;
	}

	mutex_lock(&priv->mutex);
	/* new beacon skb is allocated every time; dispose previous.*/
	if (priv->ibss_beacon)
		dev_kfree_skb(priv->ibss_beacon);

	priv->ibss_beacon = beacon;
	mutex_unlock(&priv->mutex);

606
	iwl_send_beacon_cmd(priv);
Z
Zhu Yi 已提交
607 608
}

609
/**
610
 * iwl_bg_statistics_periodic - Timer callback to queue statistics
611 612 613 614 615 616 617 618
 *
 * This callback is provided in order to send a statistics request.
 *
 * This timer function is continually reset to execute within
 * REG_RECALIB_PERIOD seconds since the last STATISTICS_NOTIFICATION
 * was received.  We need to ensure we receive the statistics in order
 * to update the temperature used for calibrating the TXPOWER.
 */
619
static void iwl_bg_statistics_periodic(unsigned long data)
620 621 622 623 624 625
{
	struct iwl_priv *priv = (struct iwl_priv *)data;

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

626 627 628 629
	/* dont send host command if rf-kill is on */
	if (!iwl_is_ready_rf(priv))
		return;

630
	iwl_send_statistics_request(priv, CMD_ASYNC, false);
631 632
}

633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679

static void iwl_print_cont_event_trace(struct iwl_priv *priv, u32 base,
					u32 start_idx, u32 num_events,
					u32 mode)
{
	u32 i;
	u32 ptr;        /* SRAM byte address of log data */
	u32 ev, time, data; /* event log data */
	unsigned long reg_flags;

	if (mode == 0)
		ptr = base + (4 * sizeof(u32)) + (start_idx * 2 * sizeof(u32));
	else
		ptr = base + (4 * sizeof(u32)) + (start_idx * 3 * sizeof(u32));

	/* Make sure device is powered up for SRAM reads */
	spin_lock_irqsave(&priv->reg_lock, reg_flags);
	if (iwl_grab_nic_access(priv)) {
		spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
		return;
	}

	/* Set starting address; reads will auto-increment */
	_iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
	rmb();

	/*
	 * "time" is actually "data" for mode 0 (no timestamp).
	 * place event id # at far right for easier visual parsing.
	 */
	for (i = 0; i < num_events; i++) {
		ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
		time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
		if (mode == 0) {
			trace_iwlwifi_dev_ucode_cont_event(priv,
							0, time, ev);
		} else {
			data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
			trace_iwlwifi_dev_ucode_cont_event(priv,
						time, data, ev);
		}
	}
	/* Allow device to power down */
	iwl_release_nic_access(priv);
	spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
}

J
Johannes Berg 已提交
680
static void iwl_continuous_event_trace(struct iwl_priv *priv)
681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757
{
	u32 capacity;   /* event log capacity in # entries */
	u32 base;       /* SRAM byte address of event log header */
	u32 mode;       /* 0 - no timestamp, 1 - timestamp recorded */
	u32 num_wraps;  /* # times uCode wrapped to top of log */
	u32 next_entry; /* index of next entry to be written by uCode */

	if (priv->ucode_type == UCODE_INIT)
		base = le32_to_cpu(priv->card_alive_init.error_event_table_ptr);
	else
		base = le32_to_cpu(priv->card_alive.log_event_table_ptr);
	if (priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
		capacity = iwl_read_targ_mem(priv, base);
		num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
		mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
		next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));
	} else
		return;

	if (num_wraps == priv->event_log.num_wraps) {
		iwl_print_cont_event_trace(priv,
				       base, priv->event_log.next_entry,
				       next_entry - priv->event_log.next_entry,
				       mode);
		priv->event_log.non_wraps_count++;
	} else {
		if ((num_wraps - priv->event_log.num_wraps) > 1)
			priv->event_log.wraps_more_count++;
		else
			priv->event_log.wraps_once_count++;
		trace_iwlwifi_dev_ucode_wrap_event(priv,
				num_wraps - priv->event_log.num_wraps,
				next_entry, priv->event_log.next_entry);
		if (next_entry < priv->event_log.next_entry) {
			iwl_print_cont_event_trace(priv, base,
			       priv->event_log.next_entry,
			       capacity - priv->event_log.next_entry,
			       mode);

			iwl_print_cont_event_trace(priv, base, 0,
				next_entry, mode);
		} else {
			iwl_print_cont_event_trace(priv, base,
			       next_entry, capacity - next_entry,
			       mode);

			iwl_print_cont_event_trace(priv, base, 0,
				next_entry, mode);
		}
	}
	priv->event_log.num_wraps = num_wraps;
	priv->event_log.next_entry = next_entry;
}

/**
 * iwl_bg_ucode_trace - Timer callback to log ucode event
 *
 * The timer is continually set to execute every
 * UCODE_TRACE_PERIOD milliseconds after the last timer expired
 * this function is to perform continuous uCode event logging operation
 * if enabled
 */
static void iwl_bg_ucode_trace(unsigned long data)
{
	struct iwl_priv *priv = (struct iwl_priv *)data;

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

	if (priv->event_log.ucode_trace) {
		iwl_continuous_event_trace(priv);
		/* Reschedule the timer to occur in UCODE_TRACE_PERIOD */
		mod_timer(&priv->ucode_trace,
			 jiffies + msecs_to_jiffies(UCODE_TRACE_PERIOD));
	}
}

758
static void iwl_rx_beacon_notif(struct iwl_priv *priv,
759
				struct iwl_rx_mem_buffer *rxb)
Z
Zhu Yi 已提交
760
{
761
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
762
	struct iwl_rx_packet *pkt = rxb_addr(rxb);
763 764
	struct iwl4965_beacon_notif *beacon =
		(struct iwl4965_beacon_notif *)pkt->u.raw;
765
	u8 rate = iwl_hw_get_rate(beacon->beacon_notify_hdr.rate_n_flags);
Z
Zhu Yi 已提交
766

767
	IWL_DEBUG_RX(priv, "beacon status %x retries %d iss %d "
Z
Zhu Yi 已提交
768
		"tsf %d %d rate %d\n",
769
		le32_to_cpu(beacon->beacon_notify_hdr.u.status) & TX_STATUS_MSK,
Z
Zhu Yi 已提交
770 771 772 773 774 775
		beacon->beacon_notify_hdr.failure_frame,
		le32_to_cpu(beacon->ibss_mgr_status),
		le32_to_cpu(beacon->high_tsf),
		le32_to_cpu(beacon->low_tsf), rate);
#endif

776
	if ((priv->iw_mode == NL80211_IFTYPE_AP) &&
Z
Zhu Yi 已提交
777 778 779 780 781 782
	    (!test_bit(STATUS_EXIT_PENDING, &priv->status)))
		queue_work(priv->workqueue, &priv->beacon_update);
}

/* Handle notification from uCode that card's power state is changing
 * due to software, hardware, or critical temperature RFKILL */
783
static void iwl_rx_card_state_notif(struct iwl_priv *priv,
784
				    struct iwl_rx_mem_buffer *rxb)
Z
Zhu Yi 已提交
785
{
Z
Zhu Yi 已提交
786
	struct iwl_rx_packet *pkt = rxb_addr(rxb);
Z
Zhu Yi 已提交
787 788 789
	u32 flags = le32_to_cpu(pkt->u.card_state_notif.flags);
	unsigned long status = priv->status;

W
Wey-Yi Guy 已提交
790
	IWL_DEBUG_RF_KILL(priv, "Card state received: HW:%s SW:%s CT:%s\n",
Z
Zhu Yi 已提交
791
			  (flags & HW_CARD_DISABLED) ? "Kill" : "On",
W
Wey-Yi Guy 已提交
792 793 794
			  (flags & SW_CARD_DISABLED) ? "Kill" : "On",
			  (flags & CT_CARD_DISABLED) ?
			  "Reached" : "Not reached");
Z
Zhu Yi 已提交
795 796

	if (flags & (SW_CARD_DISABLED | HW_CARD_DISABLED |
W
Wey-Yi Guy 已提交
797
		     CT_CARD_DISABLED)) {
Z
Zhu Yi 已提交
798

799
		iwl_write32(priv, CSR_UCODE_DRV_GP1_SET,
Z
Zhu Yi 已提交
800 801
			    CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);

M
Mohamed Abbas 已提交
802 803
		iwl_write_direct32(priv, HBUS_TARG_MBX_C,
					HBUS_TARG_MBX_C_REG_BIT_CMD_BLOCKED);
Z
Zhu Yi 已提交
804 805

		if (!(flags & RXON_CARD_DISABLED)) {
806
			iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
Z
Zhu Yi 已提交
807
				    CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
M
Mohamed Abbas 已提交
808
			iwl_write_direct32(priv, HBUS_TARG_MBX_C,
Z
Zhu Yi 已提交
809 810
					HBUS_TARG_MBX_C_REG_BIT_CMD_BLOCKED);
		}
W
Wey-Yi Guy 已提交
811
		if (flags & CT_CARD_DISABLED)
812
			iwl_tt_enter_ct_kill(priv);
Z
Zhu Yi 已提交
813
	}
W
Wey-Yi Guy 已提交
814
	if (!(flags & CT_CARD_DISABLED))
815
		iwl_tt_exit_ct_kill(priv);
Z
Zhu Yi 已提交
816 817 818 819 820 821 822 823

	if (flags & HW_CARD_DISABLED)
		set_bit(STATUS_RF_KILL_HW, &priv->status);
	else
		clear_bit(STATUS_RF_KILL_HW, &priv->status);


	if (!(flags & RXON_CARD_DISABLED))
824
		iwl_scan_cancel(priv);
Z
Zhu Yi 已提交
825 826

	if ((test_bit(STATUS_RF_KILL_HW, &status) !=
J
Johannes Berg 已提交
827 828 829
	     test_bit(STATUS_RF_KILL_HW, &priv->status)))
		wiphy_rfkill_set_hw_state(priv->hw->wiphy,
			test_bit(STATUS_RF_KILL_HW, &priv->status));
Z
Zhu Yi 已提交
830 831 832 833
	else
		wake_up_interruptible(&priv->wait_command_queue);
}

834
int iwl_set_pwr_src(struct iwl_priv *priv, enum iwl_pwr_src src)
835 836
{
	if (src == IWL_PWR_SRC_VAUX) {
837
		if (pci_pme_capable(priv->pci_dev, PCI_D3cold))
838 839 840 841 842 843 844 845 846
			iwl_set_bits_mask_prph(priv, APMG_PS_CTRL_REG,
					       APMG_PS_CTRL_VAL_PWR_SRC_VAUX,
					       ~APMG_PS_CTRL_MSK_PWR_SRC);
	} else {
		iwl_set_bits_mask_prph(priv, APMG_PS_CTRL_REG,
				       APMG_PS_CTRL_VAL_PWR_SRC_VMAIN,
				       ~APMG_PS_CTRL_MSK_PWR_SRC);
	}

M
Mohamed Abbas 已提交
847
	return 0;
848 849
}

Z
Zhu Yi 已提交
850
/**
851
 * iwl_setup_rx_handlers - Initialize Rx handler callbacks
Z
Zhu Yi 已提交
852 853 854 855 856 857 858
 *
 * Setup the RX handlers for each of the reply types sent from the uCode
 * to the host.
 *
 * This function chains into the hardware specific files for them to setup
 * any hardware specific handlers as well.
 */
859
static void iwl_setup_rx_handlers(struct iwl_priv *priv)
Z
Zhu Yi 已提交
860
{
861
	priv->rx_handlers[REPLY_ALIVE] = iwl_rx_reply_alive;
862 863
	priv->rx_handlers[REPLY_ERROR] = iwl_rx_reply_error;
	priv->rx_handlers[CHANNEL_SWITCH_NOTIFICATION] = iwl_rx_csa;
864 865
	priv->rx_handlers[SPECTRUM_MEASURE_NOTIFICATION] =
			iwl_rx_spectrum_measure_notif;
866
	priv->rx_handlers[PM_SLEEP_NOTIFICATION] = iwl_rx_pm_sleep_notif;
Z
Zhu Yi 已提交
867
	priv->rx_handlers[PM_DEBUG_STATISTIC_NOTIFIC] =
868 869
	    iwl_rx_pm_debug_statistics_notif;
	priv->rx_handlers[BEACON_NOTIFICATION] = iwl_rx_beacon_notif;
Z
Zhu Yi 已提交
870

871 872 873 874
	/*
	 * The same handler is used for both the REPLY to a discrete
	 * statistics request from the host as well as for the periodic
	 * statistics notifications (after received beacons) from the uCode.
Z
Zhu Yi 已提交
875
	 */
876
	priv->rx_handlers[REPLY_STATISTICS_CMD] = iwl_reply_statistics;
877
	priv->rx_handlers[STATISTICS_NOTIFICATION] = iwl_rx_statistics;
878 879 880

	iwl_setup_rx_scan_handlers(priv);

881
	/* status change handler */
882
	priv->rx_handlers[CARD_STATE_NOTIFICATION] = iwl_rx_card_state_notif;
Z
Zhu Yi 已提交
883

884 885
	priv->rx_handlers[MISSED_BEACONS_NOTIFICATION] =
	    iwl_rx_missed_beacon_notif;
886
	/* Rx handlers */
887 888
	priv->rx_handlers[REPLY_RX_PHY_CMD] = iwl_rx_reply_rx_phy;
	priv->rx_handlers[REPLY_RX_MPDU_CMD] = iwl_rx_reply_rx;
889 890
	/* block ack */
	priv->rx_handlers[REPLY_COMPRESSED_BA] = iwl_rx_reply_compressed_ba;
891
	/* Set up hardware specific Rx handlers */
892
	priv->cfg->ops->lib->rx_handler_setup(priv);
Z
Zhu Yi 已提交
893 894 895
}

/**
896
 * iwl_rx_handle - Main entry function for receiving responses from uCode
Z
Zhu Yi 已提交
897 898 899 900 901
 *
 * Uses the priv->rx_handlers callback function array to invoke
 * the appropriate handlers, including command responses,
 * frame-received notifications, and other notifications.
 */
902
void iwl_rx_handle(struct iwl_priv *priv)
Z
Zhu Yi 已提交
903
{
904
	struct iwl_rx_mem_buffer *rxb;
905
	struct iwl_rx_packet *pkt;
906
	struct iwl_rx_queue *rxq = &priv->rxq;
Z
Zhu Yi 已提交
907 908 909
	u32 r, i;
	int reclaim;
	unsigned long flags;
910
	u8 fill_rx = 0;
M
Mohamed Abbas 已提交
911
	u32 count = 8;
912
	int total_empty;
Z
Zhu Yi 已提交
913

914 915
	/* uCode's read index (stored in shared DRAM) indicates the last Rx
	 * buffer that the driver may process (last buffer filled by ucode). */
916
	r = le16_to_cpu(rxq->rb_stts->closed_rb_num) &  0x0FFF;
Z
Zhu Yi 已提交
917 918 919 920
	i = rxq->read;

	/* Rx interrupt, but nothing sent from uCode */
	if (i == r)
921
		IWL_DEBUG_RX(priv, "r = %d, i = %d\n", r, i);
Z
Zhu Yi 已提交
922

923
	/* calculate total frames need to be restock after handling RX */
924
	total_empty = r - rxq->write_actual;
925 926 927 928
	if (total_empty < 0)
		total_empty += RX_QUEUE_SIZE;

	if (total_empty > (RX_QUEUE_SIZE / 2))
929 930
		fill_rx = 1;

Z
Zhu Yi 已提交
931 932 933
	while (i != r) {
		rxb = rxq->queue[i];

934
		/* If an RXB doesn't have a Rx queue slot associated with it,
Z
Zhu Yi 已提交
935 936 937 938 939 940
		 * then a bug has been introduced in the queue refilling
		 * routines -- catch it here */
		BUG_ON(rxb == NULL);

		rxq->queue[i] = NULL;

Z
Zhu Yi 已提交
941 942 943 944
		pci_unmap_page(priv->pci_dev, rxb->page_dma,
			       PAGE_SIZE << priv->hw_params.rx_page_order,
			       PCI_DMA_FROMDEVICE);
		pkt = rxb_addr(rxb);
Z
Zhu Yi 已提交
945

J
Johannes Berg 已提交
946 947 948
		trace_iwlwifi_dev_rx(priv, pkt,
			le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK);

Z
Zhu Yi 已提交
949 950 951 952 953 954 955 956
		/* Reclaim a command buffer only if this packet is a response
		 *   to a (driver-originated) command.
		 * If the packet (e.g. Rx frame) originated from uCode,
		 *   there is no command buffer to reclaim.
		 * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
		 *   but apparently a few don't get set; catch them here. */
		reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME) &&
			(pkt->hdr.cmd != REPLY_RX_PHY_CMD) &&
957
			(pkt->hdr.cmd != REPLY_RX) &&
D
Daniel Halperin 已提交
958
			(pkt->hdr.cmd != REPLY_RX_MPDU_CMD) &&
959
			(pkt->hdr.cmd != REPLY_COMPRESSED_BA) &&
Z
Zhu Yi 已提交
960 961 962 963 964
			(pkt->hdr.cmd != STATISTICS_NOTIFICATION) &&
			(pkt->hdr.cmd != REPLY_TX);

		/* Based on type of command response or notification,
		 *   handle those that need handling via function in
965
		 *   rx_handlers table.  See iwl_setup_rx_handlers() */
Z
Zhu Yi 已提交
966
		if (priv->rx_handlers[pkt->hdr.cmd]) {
967
			IWL_DEBUG_RX(priv, "r = %d, i = %d, %s, 0x%02x\n", r,
968
				i, get_cmd_string(pkt->hdr.cmd), pkt->hdr.cmd);
969
			priv->isr_stats.rx_handlers[pkt->hdr.cmd]++;
970
			priv->rx_handlers[pkt->hdr.cmd] (priv, rxb);
Z
Zhu Yi 已提交
971 972
		} else {
			/* No handling needed */
973
			IWL_DEBUG_RX(priv,
Z
Zhu Yi 已提交
974 975 976 977 978
				"r %d i %d No handler needed for %s, 0x%02x\n",
				r, i, get_cmd_string(pkt->hdr.cmd),
				pkt->hdr.cmd);
		}

979 980 981 982 983 984 985
		/*
		 * XXX: After here, we should always check rxb->page
		 * against NULL before touching it or its virtual
		 * memory (pkt). Because some rx_handler might have
		 * already taken or freed the pages.
		 */

Z
Zhu Yi 已提交
986
		if (reclaim) {
Z
Zhu Yi 已提交
987 988
			/* Invoke any callbacks, transfer the buffer to caller,
			 * and fire off the (possibly) blocking iwl_send_cmd()
Z
Zhu Yi 已提交
989
			 * as we reclaim the driver command queue */
990
			if (rxb->page)
991
				iwl_tx_cmd_complete(priv, rxb);
Z
Zhu Yi 已提交
992
			else
993
				IWL_WARN(priv, "Claim null rxb?\n");
Z
Zhu Yi 已提交
994 995
		}

996 997 998 999
		/* Reuse the page if possible. For notification packets and
		 * SKBs that fail to Rx correctly, add them back into the
		 * rx_free list for reuse later. */
		spin_lock_irqsave(&rxq->lock, flags);
Z
Zhu Yi 已提交
1000
		if (rxb->page != NULL) {
1001 1002 1003 1004 1005 1006 1007
			rxb->page_dma = pci_map_page(priv->pci_dev, rxb->page,
				0, PAGE_SIZE << priv->hw_params.rx_page_order,
				PCI_DMA_FROMDEVICE);
			list_add_tail(&rxb->list, &rxq->rx_free);
			rxq->free_count++;
		} else
			list_add_tail(&rxb->list, &rxq->rx_used);
Z
Zhu Yi 已提交
1008 1009

		spin_unlock_irqrestore(&rxq->lock, flags);
1010

Z
Zhu Yi 已提交
1011
		i = (i + 1) & RX_QUEUE_MASK;
1012 1013 1014 1015 1016
		/* If there are a lot of unused frames,
		 * restock the Rx queue so ucode wont assert. */
		if (fill_rx) {
			count++;
			if (count >= 8) {
1017
				rxq->read = i;
1018
				iwl_rx_replenish_now(priv);
1019 1020 1021
				count = 0;
			}
		}
Z
Zhu Yi 已提交
1022 1023 1024
	}

	/* Backtrack one entry */
1025
	rxq->read = i;
1026 1027 1028 1029
	if (fill_rx)
		iwl_rx_replenish_now(priv);
	else
		iwl_rx_queue_restock(priv);
1030 1031
}

1032 1033 1034
/* call this function to flush any scheduled tasklet */
static inline void iwl_synchronize_irq(struct iwl_priv *priv)
{
T
Tomas Winkler 已提交
1035
	/* wait to make sure we flush pending tasklet*/
1036 1037 1038 1039
	synchronize_irq(priv->pci_dev->irq);
	tasklet_kill(&priv->irq_tasklet);
}

M
Mohamed Abbas 已提交
1040
static void iwl_irq_tasklet_legacy(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1041 1042 1043 1044
{
	u32 inta, handled = 0;
	u32 inta_fh;
	unsigned long flags;
1045
	u32 i;
1046
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
1047 1048 1049 1050 1051 1052 1053 1054
	u32 inta_mask;
#endif

	spin_lock_irqsave(&priv->lock, flags);

	/* Ack/clear/reset pending uCode interrupts.
	 * Note:  Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
	 *  and will clear only when CSR_FH_INT_STATUS gets cleared. */
1055 1056
	inta = iwl_read32(priv, CSR_INT);
	iwl_write32(priv, CSR_INT, inta);
Z
Zhu Yi 已提交
1057 1058 1059 1060

	/* Ack/clear/reset pending flow-handler (DMA) interrupts.
	 * Any new interrupts that happen after this, either while we're
	 * in this tasklet, or later, will show up in next ISR/tasklet. */
1061 1062
	inta_fh = iwl_read32(priv, CSR_FH_INT_STATUS);
	iwl_write32(priv, CSR_FH_INT_STATUS, inta_fh);
Z
Zhu Yi 已提交
1063

1064
#ifdef CONFIG_IWLWIFI_DEBUG
1065
	if (iwl_get_debug_level(priv) & IWL_DL_ISR) {
1066
		/* just for debug */
1067
		inta_mask = iwl_read32(priv, CSR_INT_MASK);
1068
		IWL_DEBUG_ISR(priv, "inta 0x%08x, enabled 0x%08x, fh 0x%08x\n",
Z
Zhu Yi 已提交
1069 1070 1071 1072
			      inta, inta_mask, inta_fh);
	}
#endif

Z
Zhu Yi 已提交
1073 1074
	spin_unlock_irqrestore(&priv->lock, flags);

Z
Zhu Yi 已提交
1075 1076 1077 1078
	/* Since CSR_INT and CSR_FH_INT_STATUS reads and clears are not
	 * atomic, make sure that inta covers all the interrupts that
	 * we've discovered, even if FH interrupt came in just after
	 * reading CSR_INT. */
T
Tomas Winkler 已提交
1079
	if (inta_fh & CSR49_FH_INT_RX_MASK)
Z
Zhu Yi 已提交
1080
		inta |= CSR_INT_BIT_FH_RX;
T
Tomas Winkler 已提交
1081
	if (inta_fh & CSR49_FH_INT_TX_MASK)
Z
Zhu Yi 已提交
1082 1083 1084 1085
		inta |= CSR_INT_BIT_FH_TX;

	/* Now service all interrupt bits discovered above. */
	if (inta & CSR_INT_BIT_HW_ERR) {
1086
		IWL_ERR(priv, "Hardware error detected.  Restarting.\n");
Z
Zhu Yi 已提交
1087 1088

		/* Tell the device to stop sending interrupts */
1089
		iwl_disable_interrupts(priv);
Z
Zhu Yi 已提交
1090

1091
		priv->isr_stats.hw++;
1092
		iwl_irq_handle_error(priv);
Z
Zhu Yi 已提交
1093 1094 1095 1096 1097 1098

		handled |= CSR_INT_BIT_HW_ERR;

		return;
	}

1099
#ifdef CONFIG_IWLWIFI_DEBUG
1100
	if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
Z
Zhu Yi 已提交
1101
		/* NIC fires this, but we don't use it, redundant with WAKEUP */
1102
		if (inta & CSR_INT_BIT_SCD) {
1103
			IWL_DEBUG_ISR(priv, "Scheduler finished to transmit "
1104
				      "the frame/frames.\n");
1105 1106
			priv->isr_stats.sch++;
		}
Z
Zhu Yi 已提交
1107 1108

		/* Alive notification via Rx interrupt will do the real work */
1109
		if (inta & CSR_INT_BIT_ALIVE) {
1110
			IWL_DEBUG_ISR(priv, "Alive interrupt\n");
1111 1112
			priv->isr_stats.alive++;
		}
Z
Zhu Yi 已提交
1113 1114 1115
	}
#endif
	/* Safely ignore these bits for debug checks below */
1116
	inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
Z
Zhu Yi 已提交
1117

1118
	/* HW RF KILL switch toggled */
Z
Zhu Yi 已提交
1119 1120
	if (inta & CSR_INT_BIT_RF_KILL) {
		int hw_rf_kill = 0;
1121
		if (!(iwl_read32(priv, CSR_GP_CNTRL) &
Z
Zhu Yi 已提交
1122 1123 1124
				CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW))
			hw_rf_kill = 1;

1125
		IWL_WARN(priv, "RF_KILL bit toggled to %s.\n",
1126
				hw_rf_kill ? "disable radio" : "enable radio");
Z
Zhu Yi 已提交
1127

1128 1129
		priv->isr_stats.rfkill++;

1130
		/* driver only loads ucode once setting the interface up.
1131 1132 1133
		 * the driver allows loading the ucode even if the radio
		 * is killed. Hence update the killswitch state here. The
		 * rfkill handler will care about restarting if needed.
1134
		 */
1135 1136 1137 1138 1139
		if (!test_bit(STATUS_ALIVE, &priv->status)) {
			if (hw_rf_kill)
				set_bit(STATUS_RF_KILL_HW, &priv->status);
			else
				clear_bit(STATUS_RF_KILL_HW, &priv->status);
J
Johannes Berg 已提交
1140
			wiphy_rfkill_set_hw_state(priv->hw->wiphy, hw_rf_kill);
1141
		}
Z
Zhu Yi 已提交
1142 1143 1144 1145

		handled |= CSR_INT_BIT_RF_KILL;
	}

1146
	/* Chip got too hot and stopped itself */
Z
Zhu Yi 已提交
1147
	if (inta & CSR_INT_BIT_CT_KILL) {
1148
		IWL_ERR(priv, "Microcode CT kill error detected.\n");
1149
		priv->isr_stats.ctkill++;
Z
Zhu Yi 已提交
1150 1151 1152 1153 1154
		handled |= CSR_INT_BIT_CT_KILL;
	}

	/* Error detected by uCode */
	if (inta & CSR_INT_BIT_SW_ERR) {
1155 1156
		IWL_ERR(priv, "Microcode SW error detected. "
			" Restarting 0x%X.\n", inta);
1157 1158
		priv->isr_stats.sw++;
		priv->isr_stats.sw_err = inta;
1159
		iwl_irq_handle_error(priv);
Z
Zhu Yi 已提交
1160 1161 1162
		handled |= CSR_INT_BIT_SW_ERR;
	}

1163 1164 1165 1166 1167
	/*
	 * uCode wakes up after power-down sleep.
	 * Tell device about any new tx or host commands enqueued,
	 * and about any Rx buffers made available while asleep.
	 */
Z
Zhu Yi 已提交
1168
	if (inta & CSR_INT_BIT_WAKEUP) {
1169
		IWL_DEBUG_ISR(priv, "Wakeup interrupt\n");
1170
		iwl_rx_queue_update_write_ptr(priv, &priv->rxq);
1171 1172
		for (i = 0; i < priv->hw_params.max_txq_num; i++)
			iwl_txq_update_write_ptr(priv, &priv->txq[i]);
1173
		priv->isr_stats.wakeup++;
Z
Zhu Yi 已提交
1174 1175 1176 1177 1178 1179 1180
		handled |= CSR_INT_BIT_WAKEUP;
	}

	/* All uCode command responses, including Tx command responses,
	 * Rx "responses" (frame-received notification), and other
	 * notifications from uCode come through here*/
	if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
1181
		iwl_rx_handle(priv);
1182
		priv->isr_stats.rx++;
Z
Zhu Yi 已提交
1183 1184 1185
		handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
	}

B
Ben Cahill 已提交
1186
	/* This "Tx" DMA channel is used only for loading uCode */
Z
Zhu Yi 已提交
1187
	if (inta & CSR_INT_BIT_FH_TX) {
B
Ben Cahill 已提交
1188
		IWL_DEBUG_ISR(priv, "uCode load interrupt\n");
1189
		priv->isr_stats.tx++;
Z
Zhu Yi 已提交
1190
		handled |= CSR_INT_BIT_FH_TX;
B
Ben Cahill 已提交
1191
		/* Wake up uCode load routine, now that load is complete */
1192 1193
		priv->ucode_write_complete = 1;
		wake_up_interruptible(&priv->wait_command_queue);
Z
Zhu Yi 已提交
1194 1195
	}

1196
	if (inta & ~handled) {
1197
		IWL_ERR(priv, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
1198 1199
		priv->isr_stats.unhandled++;
	}
Z
Zhu Yi 已提交
1200

1201
	if (inta & ~(priv->inta_mask)) {
1202
		IWL_WARN(priv, "Disabled INTA bits 0x%08x were pending\n",
1203
			 inta & ~priv->inta_mask);
1204
		IWL_WARN(priv, "   with FH_INT = 0x%08x\n", inta_fh);
Z
Zhu Yi 已提交
1205 1206 1207
	}

	/* Re-enable all interrupts */
1208 1209
	/* only Re-enable if diabled by irq */
	if (test_bit(STATUS_INT_ENABLED, &priv->status))
1210
		iwl_enable_interrupts(priv);
Z
Zhu Yi 已提交
1211

1212
#ifdef CONFIG_IWLWIFI_DEBUG
1213
	if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
1214 1215 1216
		inta = iwl_read32(priv, CSR_INT);
		inta_mask = iwl_read32(priv, CSR_INT_MASK);
		inta_fh = iwl_read32(priv, CSR_FH_INT_STATUS);
1217
		IWL_DEBUG_ISR(priv, "End inta 0x%08x, enabled 0x%08x, fh 0x%08x, "
Z
Zhu Yi 已提交
1218 1219 1220 1221 1222
			"flags 0x%08lx\n", inta, inta_mask, inta_fh, flags);
	}
#endif
}

M
Mohamed Abbas 已提交
1223 1224 1225 1226 1227 1228
/* tasklet for iwlagn interrupt */
static void iwl_irq_tasklet(struct iwl_priv *priv)
{
	u32 inta = 0;
	u32 handled = 0;
	unsigned long flags;
1229
	u32 i;
M
Mohamed Abbas 已提交
1230 1231 1232 1233 1234 1235 1236 1237 1238
#ifdef CONFIG_IWLWIFI_DEBUG
	u32 inta_mask;
#endif

	spin_lock_irqsave(&priv->lock, flags);

	/* Ack/clear/reset pending uCode interrupts.
	 * Note:  Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
	 */
1239
	iwl_write32(priv, CSR_INT, priv->_agn.inta);
M
Mohamed Abbas 已提交
1240

1241
	inta = priv->_agn.inta;
M
Mohamed Abbas 已提交
1242 1243

#ifdef CONFIG_IWLWIFI_DEBUG
1244
	if (iwl_get_debug_level(priv) & IWL_DL_ISR) {
M
Mohamed Abbas 已提交
1245 1246 1247 1248 1249 1250
		/* just for debug */
		inta_mask = iwl_read32(priv, CSR_INT_MASK);
		IWL_DEBUG_ISR(priv, "inta 0x%08x, enabled 0x%08x\n ",
				inta, inta_mask);
	}
#endif
Z
Zhu Yi 已提交
1251 1252 1253

	spin_unlock_irqrestore(&priv->lock, flags);

1254 1255
	/* saved interrupt in inta variable now we can reset priv->_agn.inta */
	priv->_agn.inta = 0;
M
Mohamed Abbas 已提交
1256 1257 1258

	/* Now service all interrupt bits discovered above. */
	if (inta & CSR_INT_BIT_HW_ERR) {
1259
		IWL_ERR(priv, "Hardware error detected.  Restarting.\n");
M
Mohamed Abbas 已提交
1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272

		/* Tell the device to stop sending interrupts */
		iwl_disable_interrupts(priv);

		priv->isr_stats.hw++;
		iwl_irq_handle_error(priv);

		handled |= CSR_INT_BIT_HW_ERR;

		return;
	}

#ifdef CONFIG_IWLWIFI_DEBUG
1273
	if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
M
Mohamed Abbas 已提交
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
		/* NIC fires this, but we don't use it, redundant with WAKEUP */
		if (inta & CSR_INT_BIT_SCD) {
			IWL_DEBUG_ISR(priv, "Scheduler finished to transmit "
				      "the frame/frames.\n");
			priv->isr_stats.sch++;
		}

		/* Alive notification via Rx interrupt will do the real work */
		if (inta & CSR_INT_BIT_ALIVE) {
			IWL_DEBUG_ISR(priv, "Alive interrupt\n");
			priv->isr_stats.alive++;
		}
	}
#endif
	/* Safely ignore these bits for debug checks below */
	inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);

	/* HW RF KILL switch toggled */
	if (inta & CSR_INT_BIT_RF_KILL) {
		int hw_rf_kill = 0;
		if (!(iwl_read32(priv, CSR_GP_CNTRL) &
				CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW))
			hw_rf_kill = 1;

1298
		IWL_WARN(priv, "RF_KILL bit toggled to %s.\n",
M
Mohamed Abbas 已提交
1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312
				hw_rf_kill ? "disable radio" : "enable radio");

		priv->isr_stats.rfkill++;

		/* driver only loads ucode once setting the interface up.
		 * the driver allows loading the ucode even if the radio
		 * is killed. Hence update the killswitch state here. The
		 * rfkill handler will care about restarting if needed.
		 */
		if (!test_bit(STATUS_ALIVE, &priv->status)) {
			if (hw_rf_kill)
				set_bit(STATUS_RF_KILL_HW, &priv->status);
			else
				clear_bit(STATUS_RF_KILL_HW, &priv->status);
J
Johannes Berg 已提交
1313
			wiphy_rfkill_set_hw_state(priv->hw->wiphy, hw_rf_kill);
M
Mohamed Abbas 已提交
1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339
		}

		handled |= CSR_INT_BIT_RF_KILL;
	}

	/* Chip got too hot and stopped itself */
	if (inta & CSR_INT_BIT_CT_KILL) {
		IWL_ERR(priv, "Microcode CT kill error detected.\n");
		priv->isr_stats.ctkill++;
		handled |= CSR_INT_BIT_CT_KILL;
	}

	/* Error detected by uCode */
	if (inta & CSR_INT_BIT_SW_ERR) {
		IWL_ERR(priv, "Microcode SW error detected. "
			" Restarting 0x%X.\n", inta);
		priv->isr_stats.sw++;
		priv->isr_stats.sw_err = inta;
		iwl_irq_handle_error(priv);
		handled |= CSR_INT_BIT_SW_ERR;
	}

	/* uCode wakes up after power-down sleep */
	if (inta & CSR_INT_BIT_WAKEUP) {
		IWL_DEBUG_ISR(priv, "Wakeup interrupt\n");
		iwl_rx_queue_update_write_ptr(priv, &priv->rxq);
1340 1341
		for (i = 0; i < priv->hw_params.max_txq_num; i++)
			iwl_txq_update_write_ptr(priv, &priv->txq[i]);
M
Mohamed Abbas 已提交
1342 1343 1344 1345 1346 1347 1348 1349 1350

		priv->isr_stats.wakeup++;

		handled |= CSR_INT_BIT_WAKEUP;
	}

	/* All uCode command responses, including Tx command responses,
	 * Rx "responses" (frame-received notification), and other
	 * notifications from uCode come through here*/
1351 1352
	if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
			CSR_INT_BIT_RX_PERIODIC)) {
M
Mohamed Abbas 已提交
1353
		IWL_DEBUG_ISR(priv, "Rx interrupt\n");
1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369
		if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
			handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
			iwl_write32(priv, CSR_FH_INT_STATUS,
					CSR49_FH_INT_RX_MASK);
		}
		if (inta & CSR_INT_BIT_RX_PERIODIC) {
			handled |= CSR_INT_BIT_RX_PERIODIC;
			iwl_write32(priv, CSR_INT, CSR_INT_BIT_RX_PERIODIC);
		}
		/* Sending RX interrupt require many steps to be done in the
		 * the device:
		 * 1- write interrupt to current index in ICT table.
		 * 2- dma RX frame.
		 * 3- update RX shared data to indicate last write index.
		 * 4- send interrupt.
		 * This could lead to RX race, driver could receive RX interrupt
1370 1371
		 * but the shared data changes does not reflect this;
		 * periodic interrupt will detect any dangling Rx activity.
1372
		 */
1373 1374 1375

		/* Disable periodic interrupt; we use it as just a one-shot. */
		iwl_write8(priv, CSR_INT_PERIODIC_REG,
1376
			    CSR_INT_PERIODIC_DIS);
M
Mohamed Abbas 已提交
1377
		iwl_rx_handle(priv);
1378 1379 1380 1381 1382 1383 1384 1385

		/*
		 * Enable periodic interrupt in 8 msec only if we received
		 * real RX interrupt (instead of just periodic int), to catch
		 * any dangling Rx interrupt.  If it was just the periodic
		 * interrupt, there was no dangling Rx activity, and no need
		 * to extend the periodic interrupt; one-shot is enough.
		 */
1386
		if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
1387
			iwl_write8(priv, CSR_INT_PERIODIC_REG,
1388 1389
				    CSR_INT_PERIODIC_ENA);

M
Mohamed Abbas 已提交
1390 1391 1392
		priv->isr_stats.rx++;
	}

B
Ben Cahill 已提交
1393
	/* This "Tx" DMA channel is used only for loading uCode */
M
Mohamed Abbas 已提交
1394 1395
	if (inta & CSR_INT_BIT_FH_TX) {
		iwl_write32(priv, CSR_FH_INT_STATUS, CSR49_FH_INT_TX_MASK);
B
Ben Cahill 已提交
1396
		IWL_DEBUG_ISR(priv, "uCode load interrupt\n");
M
Mohamed Abbas 已提交
1397 1398
		priv->isr_stats.tx++;
		handled |= CSR_INT_BIT_FH_TX;
B
Ben Cahill 已提交
1399
		/* Wake up uCode load routine, now that load is complete */
M
Mohamed Abbas 已提交
1400 1401 1402 1403 1404 1405 1406 1407 1408
		priv->ucode_write_complete = 1;
		wake_up_interruptible(&priv->wait_command_queue);
	}

	if (inta & ~handled) {
		IWL_ERR(priv, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
		priv->isr_stats.unhandled++;
	}

1409
	if (inta & ~(priv->inta_mask)) {
M
Mohamed Abbas 已提交
1410
		IWL_WARN(priv, "Disabled INTA bits 0x%08x were pending\n",
1411
			 inta & ~priv->inta_mask);
M
Mohamed Abbas 已提交
1412 1413 1414 1415 1416 1417 1418 1419
	}

	/* Re-enable all interrupts */
	/* only Re-enable if diabled by irq */
	if (test_bit(STATUS_INT_ENABLED, &priv->status))
		iwl_enable_interrupts(priv);
}

1420

Z
Zhu Yi 已提交
1421 1422 1423 1424 1425 1426
/******************************************************************************
 *
 * uCode download functions
 *
 ******************************************************************************/

1427
static void iwl_dealloc_ucode_pci(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1428
{
1429 1430 1431 1432 1433 1434
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_code);
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_data);
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_data_backup);
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init);
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init_data);
	iwl_free_fw_desc(priv->pci_dev, &priv->ucode_boot);
Z
Zhu Yi 已提交
1435 1436
}

1437
static void iwl_nic_start(struct iwl_priv *priv)
1438 1439 1440 1441 1442 1443
{
	/* Remove all resets to allow NIC to operate */
	iwl_write32(priv, CSR_RESET, 0);
}


1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context);
static int iwl_mac_setup_register(struct iwl_priv *priv);

static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
{
	const char *name_pre = priv->cfg->fw_name_pre;

	if (first)
		priv->fw_index = priv->cfg->ucode_api_max;
	else
		priv->fw_index--;

	if (priv->fw_index < priv->cfg->ucode_api_min) {
		IWL_ERR(priv, "no suitable firmware found!\n");
		return -ENOENT;
	}

	sprintf(priv->firmware_name, "%s%d%s",
		name_pre, priv->fw_index, ".ucode");

	IWL_DEBUG_INFO(priv, "attempting to load firmware '%s'\n",
		       priv->firmware_name);

	return request_firmware_nowait(THIS_MODULE, 1, priv->firmware_name,
				       &priv->pci_dev->dev, GFP_KERNEL, priv,
				       iwl_ucode_callback);
}

Z
Zhu Yi 已提交
1472
/**
1473
 * iwl_ucode_callback - callback when firmware was loaded
Z
Zhu Yi 已提交
1474
 *
1475 1476
 * If loaded successfully, copies the firmware into buffers
 * for the card to fetch (via DMA).
Z
Zhu Yi 已提交
1477
 */
1478
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context)
Z
Zhu Yi 已提交
1479
{
1480
	struct iwl_priv *priv = context;
1481
	struct iwl_ucode_header *ucode;
1482 1483
	const unsigned int api_max = priv->cfg->ucode_api_max;
	const unsigned int api_min = priv->cfg->ucode_api_min;
Z
Zhu Yi 已提交
1484 1485
	u8 *src;
	size_t len;
1486 1487
	u32 api_ver, build;
	u32 inst_size, data_size, init_size, init_data_size, boot_size;
1488
	int err;
1489
	u16 eeprom_ver;
Z
Zhu Yi 已提交
1490

1491 1492 1493 1494
	if (!ucode_raw) {
		IWL_ERR(priv, "request for firmware file '%s' failed.\n",
			priv->firmware_name);
		goto try_again;
Z
Zhu Yi 已提交
1495 1496
	}

1497 1498
	IWL_DEBUG_INFO(priv, "Loaded firmware file '%s' (%zd bytes).\n",
		       priv->firmware_name, ucode_raw->size);
Z
Zhu Yi 已提交
1499

1500 1501
	/* Make sure that we got at least the v1 header! */
	if (ucode_raw->size < priv->cfg->ops->ucode->get_header_size(1)) {
1502
		IWL_ERR(priv, "File size way too small!\n");
1503
		goto try_again;
Z
Zhu Yi 已提交
1504 1505 1506
	}

	/* Data from ucode file:  header followed by uCode images */
1507
	ucode = (struct iwl_ucode_header *)ucode_raw->data;
Z
Zhu Yi 已提交
1508

1509
	priv->ucode_ver = le32_to_cpu(ucode->ver);
1510
	api_ver = IWL_UCODE_API(priv->ucode_ver);
1511 1512 1513 1514 1515 1516 1517 1518
	build = priv->cfg->ops->ucode->get_build(ucode, api_ver);
	inst_size = priv->cfg->ops->ucode->get_inst_size(ucode, api_ver);
	data_size = priv->cfg->ops->ucode->get_data_size(ucode, api_ver);
	init_size = priv->cfg->ops->ucode->get_init_size(ucode, api_ver);
	init_data_size =
		priv->cfg->ops->ucode->get_init_data_size(ucode, api_ver);
	boot_size = priv->cfg->ops->ucode->get_boot_size(ucode, api_ver);
	src = priv->cfg->ops->ucode->get_data(ucode, api_ver);
Z
Zhu Yi 已提交
1519

1520 1521
	/* api_ver should match the api version forming part of the
	 * firmware filename ... but we don't check for that and only rely
1522
	 * on the API version read from firmware header from here on forward */
1523 1524

	if (api_ver < api_min || api_ver > api_max) {
1525
		IWL_ERR(priv, "Driver unable to support your firmware API. "
1526 1527
			  "Driver supports v%u, firmware is v%u.\n",
			  api_max, api_ver);
1528
		goto try_again;
1529
	}
1530

1531
	if (api_ver != api_max)
T
Tomas Winkler 已提交
1532
		IWL_ERR(priv, "Firmware has old API version. Expected v%u, "
1533 1534 1535 1536
			  "got v%u. New firmware can be obtained "
			  "from http://www.intellinuxwireless.org.\n",
			  api_max, api_ver);

T
Tomas Winkler 已提交
1537 1538 1539 1540 1541
	IWL_INFO(priv, "loaded firmware version %u.%u.%u.%u\n",
	       IWL_UCODE_MAJOR(priv->ucode_ver),
	       IWL_UCODE_MINOR(priv->ucode_ver),
	       IWL_UCODE_API(priv->ucode_ver),
	       IWL_UCODE_SERIAL(priv->ucode_ver));
1542

1543 1544 1545 1546 1547 1548 1549 1550
	snprintf(priv->hw->wiphy->fw_version,
		 sizeof(priv->hw->wiphy->fw_version),
		 "%u.%u.%u.%u",
		 IWL_UCODE_MAJOR(priv->ucode_ver),
		 IWL_UCODE_MINOR(priv->ucode_ver),
		 IWL_UCODE_API(priv->ucode_ver),
		 IWL_UCODE_SERIAL(priv->ucode_ver));

1551 1552 1553
	if (build)
		IWL_DEBUG_INFO(priv, "Build %u\n", build);

1554 1555 1556 1557 1558
	eeprom_ver = iwl_eeprom_query16(priv, EEPROM_VERSION);
	IWL_DEBUG_INFO(priv, "NVM Type: %s, version: 0x%x\n",
		       (priv->nvm_device_type == NVM_DEVICE_TYPE_OTP)
		       ? "OTP" : "EEPROM", eeprom_ver);

1559
	IWL_DEBUG_INFO(priv, "f/w package hdr ucode version raw = 0x%x\n",
1560
		       priv->ucode_ver);
1561
	IWL_DEBUG_INFO(priv, "f/w package hdr runtime inst size = %u\n",
Z
Zhu Yi 已提交
1562
		       inst_size);
1563
	IWL_DEBUG_INFO(priv, "f/w package hdr runtime data size = %u\n",
Z
Zhu Yi 已提交
1564
		       data_size);
1565
	IWL_DEBUG_INFO(priv, "f/w package hdr init inst size = %u\n",
Z
Zhu Yi 已提交
1566
		       init_size);
1567
	IWL_DEBUG_INFO(priv, "f/w package hdr init data size = %u\n",
Z
Zhu Yi 已提交
1568
		       init_data_size);
1569
	IWL_DEBUG_INFO(priv, "f/w package hdr boot inst size = %u\n",
Z
Zhu Yi 已提交
1570 1571
		       boot_size);

1572 1573 1574 1575 1576 1577
	/*
	 * For any of the failures below (before allocating pci memory)
	 * we will try to load a version with a smaller API -- maybe the
	 * user just got a corrupted version of the latest API.
	 */

Z
Zhu Yi 已提交
1578
	/* Verify size of file vs. image size info in file's header */
1579 1580
	if (ucode_raw->size !=
		priv->cfg->ops->ucode->get_header_size(api_ver) +
Z
Zhu Yi 已提交
1581 1582 1583
		inst_size + data_size + init_size +
		init_data_size + boot_size) {

1584 1585 1586
		IWL_DEBUG_INFO(priv,
			"uCode file size %d does not match expected size\n",
			(int)ucode_raw->size);
1587
		goto try_again;
Z
Zhu Yi 已提交
1588 1589 1590
	}

	/* Verify that uCode images will fit in card's SRAM */
1591
	if (inst_size > priv->hw_params.max_inst_size) {
1592
		IWL_DEBUG_INFO(priv, "uCode instr len %d too large to fit in\n",
1593
			       inst_size);
1594
		goto try_again;
Z
Zhu Yi 已提交
1595 1596
	}

1597
	if (data_size > priv->hw_params.max_data_size) {
1598
		IWL_DEBUG_INFO(priv, "uCode data len %d too large to fit in\n",
1599
				data_size);
1600
		goto try_again;
Z
Zhu Yi 已提交
1601
	}
1602
	if (init_size > priv->hw_params.max_inst_size) {
1603 1604
		IWL_INFO(priv, "uCode init instr len %d too large to fit in\n",
			init_size);
1605
		goto try_again;
Z
Zhu Yi 已提交
1606
	}
1607
	if (init_data_size > priv->hw_params.max_data_size) {
1608
		IWL_INFO(priv, "uCode init data len %d too large to fit in\n",
1609
		      init_data_size);
1610
		goto try_again;
Z
Zhu Yi 已提交
1611
	}
1612
	if (boot_size > priv->hw_params.max_bsm_size) {
1613 1614
		IWL_INFO(priv, "uCode boot instr len %d too large to fit in\n",
			boot_size);
1615
		goto try_again;
Z
Zhu Yi 已提交
1616 1617 1618 1619 1620 1621 1622 1623
	}

	/* Allocate ucode buffers for card's bus-master loading ... */

	/* Runtime instructions and 2 copies of data:
	 * 1) unmodified from disk
	 * 2) backup cache for save/restore during power-downs */
	priv->ucode_code.len = inst_size;
1624
	iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_code);
Z
Zhu Yi 已提交
1625 1626

	priv->ucode_data.len = data_size;
1627
	iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_data);
Z
Zhu Yi 已提交
1628 1629

	priv->ucode_data_backup.len = data_size;
1630
	iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_data_backup);
Z
Zhu Yi 已提交
1631

1632 1633 1634 1635
	if (!priv->ucode_code.v_addr || !priv->ucode_data.v_addr ||
	    !priv->ucode_data_backup.v_addr)
		goto err_pci_alloc;

Z
Zhu Yi 已提交
1636
	/* Initialization instructions and data */
1637 1638
	if (init_size && init_data_size) {
		priv->ucode_init.len = init_size;
1639
		iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init);
1640 1641

		priv->ucode_init_data.len = init_data_size;
1642
		iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init_data);
1643 1644 1645 1646

		if (!priv->ucode_init.v_addr || !priv->ucode_init_data.v_addr)
			goto err_pci_alloc;
	}
Z
Zhu Yi 已提交
1647 1648

	/* Bootstrap (instructions only, no data) */
1649 1650
	if (boot_size) {
		priv->ucode_boot.len = boot_size;
1651
		iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_boot);
Z
Zhu Yi 已提交
1652

1653 1654 1655
		if (!priv->ucode_boot.v_addr)
			goto err_pci_alloc;
	}
Z
Zhu Yi 已提交
1656 1657 1658 1659

	/* Copy images into buffers for card's bus-master reads ... */

	/* Runtime instructions (first block of data in file) */
1660
	len = inst_size;
1661
	IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode instr len %Zd\n", len);
Z
Zhu Yi 已提交
1662
	memcpy(priv->ucode_code.v_addr, src, len);
1663 1664
	src += len;

1665
	IWL_DEBUG_INFO(priv, "uCode instr buf vaddr = 0x%p, paddr = 0x%08x\n",
Z
Zhu Yi 已提交
1666 1667 1668
		priv->ucode_code.v_addr, (u32)priv->ucode_code.p_addr);

	/* Runtime data (2nd block)
1669
	 * NOTE:  Copy into backup buffer will be done in iwl_up()  */
1670
	len = data_size;
1671
	IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode data len %Zd\n", len);
Z
Zhu Yi 已提交
1672 1673
	memcpy(priv->ucode_data.v_addr, src, len);
	memcpy(priv->ucode_data_backup.v_addr, src, len);
1674
	src += len;
Z
Zhu Yi 已提交
1675 1676 1677

	/* Initialization instructions (3rd block) */
	if (init_size) {
1678
		len = init_size;
1679
		IWL_DEBUG_INFO(priv, "Copying (but not loading) init instr len %Zd\n",
1680
				len);
Z
Zhu Yi 已提交
1681
		memcpy(priv->ucode_init.v_addr, src, len);
1682
		src += len;
Z
Zhu Yi 已提交
1683 1684 1685 1686
	}

	/* Initialization data (4th block) */
	if (init_data_size) {
1687
		len = init_data_size;
1688
		IWL_DEBUG_INFO(priv, "Copying (but not loading) init data len %Zd\n",
1689
			       len);
Z
Zhu Yi 已提交
1690
		memcpy(priv->ucode_init_data.v_addr, src, len);
1691
		src += len;
Z
Zhu Yi 已提交
1692 1693 1694
	}

	/* Bootstrap instructions (5th block) */
1695
	len = boot_size;
1696
	IWL_DEBUG_INFO(priv, "Copying (but not loading) boot instr len %Zd\n", len);
Z
Zhu Yi 已提交
1697 1698
	memcpy(priv->ucode_boot.v_addr, src, len);

1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711
	/**************************************************
	 * This is still part of probe() in a sense...
	 *
	 * 9. Setup and register with mac80211 and debugfs
	 **************************************************/
	err = iwl_mac_setup_register(priv);
	if (err)
		goto out_unbind;

	err = iwl_dbgfs_register(priv, DRV_NAME);
	if (err)
		IWL_ERR(priv, "failed to create debugfs files. Ignoring error: %d\n", err);

Z
Zhu Yi 已提交
1712 1713
	/* We have our copies now, allow OS release its copies */
	release_firmware(ucode_raw);
1714 1715 1716 1717 1718 1719 1720 1721
	return;

 try_again:
	/* try next, if any */
	if (iwl_request_firmware(priv, false))
		goto out_unbind;
	release_firmware(ucode_raw);
	return;
Z
Zhu Yi 已提交
1722 1723

 err_pci_alloc:
1724
	IWL_ERR(priv, "failed to allocate pci memory\n");
1725
	iwl_dealloc_ucode_pci(priv);
1726 1727
 out_unbind:
	device_release_driver(&priv->pci_dev->dev);
Z
Zhu Yi 已提交
1728 1729 1730
	release_firmware(ucode_raw);
}

1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759
static const char *desc_lookup_text[] = {
	"OK",
	"FAIL",
	"BAD_PARAM",
	"BAD_CHECKSUM",
	"NMI_INTERRUPT_WDG",
	"SYSASSERT",
	"FATAL_ERROR",
	"BAD_COMMAND",
	"HW_ERROR_TUNE_LOCK",
	"HW_ERROR_TEMPERATURE",
	"ILLEGAL_CHAN_FREQ",
	"VCC_NOT_STABLE",
	"FH_ERROR",
	"NMI_INTERRUPT_HOST",
	"NMI_INTERRUPT_ACTION_PT",
	"NMI_INTERRUPT_UNKNOWN",
	"UCODE_VERSION_MISMATCH",
	"HW_ERROR_ABS_LOCK",
	"HW_ERROR_CAL_LOCK_FAIL",
	"NMI_INTERRUPT_INST_ACTION_PT",
	"NMI_INTERRUPT_DATA_ACTION_PT",
	"NMI_TRM_HW_ER",
	"NMI_INTERRUPT_TRM",
	"NMI_INTERRUPT_BREAK_POINT"
	"DEBUG_0",
	"DEBUG_1",
	"DEBUG_2",
	"DEBUG_3",
1760
	"ADVANCED SYSASSERT"
1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787
};

static const char *desc_lookup(int i)
{
	int max = ARRAY_SIZE(desc_lookup_text) - 1;

	if (i < 0 || i > max)
		i = max;

	return desc_lookup_text[i];
}

#define ERROR_START_OFFSET  (1 * sizeof(u32))
#define ERROR_ELEM_SIZE     (7 * sizeof(u32))

void iwl_dump_nic_error_log(struct iwl_priv *priv)
{
	u32 data2, line;
	u32 desc, time, count, base, data1;
	u32 blink1, blink2, ilink1, ilink2;

	if (priv->ucode_type == UCODE_INIT)
		base = le32_to_cpu(priv->card_alive_init.error_event_table_ptr);
	else
		base = le32_to_cpu(priv->card_alive.error_event_table_ptr);

	if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
1788 1789 1790
		IWL_ERR(priv,
			"Not valid error log pointer 0x%08X for %s uCode\n",
			base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811
		return;
	}

	count = iwl_read_targ_mem(priv, base);

	if (ERROR_START_OFFSET <= count * ERROR_ELEM_SIZE) {
		IWL_ERR(priv, "Start IWL Error Log Dump:\n");
		IWL_ERR(priv, "Status: 0x%08lX, count: %d\n",
			priv->status, count);
	}

	desc = iwl_read_targ_mem(priv, base + 1 * sizeof(u32));
	blink1 = iwl_read_targ_mem(priv, base + 3 * sizeof(u32));
	blink2 = iwl_read_targ_mem(priv, base + 4 * sizeof(u32));
	ilink1 = iwl_read_targ_mem(priv, base + 5 * sizeof(u32));
	ilink2 = iwl_read_targ_mem(priv, base + 6 * sizeof(u32));
	data1 = iwl_read_targ_mem(priv, base + 7 * sizeof(u32));
	data2 = iwl_read_targ_mem(priv, base + 8 * sizeof(u32));
	line = iwl_read_targ_mem(priv, base + 9 * sizeof(u32));
	time = iwl_read_targ_mem(priv, base + 11 * sizeof(u32));

J
Johannes Berg 已提交
1812 1813 1814
	trace_iwlwifi_dev_ucode_error(priv, desc, time, data1, data2, line,
				      blink1, blink2, ilink1, ilink2);

1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830
	IWL_ERR(priv, "Desc                               Time       "
		"data1      data2      line\n");
	IWL_ERR(priv, "%-28s (#%02d) %010u 0x%08X 0x%08X %u\n",
		desc_lookup(desc), desc, time, data1, data2, line);
	IWL_ERR(priv, "blink1  blink2  ilink1  ilink2\n");
	IWL_ERR(priv, "0x%05X 0x%05X 0x%05X 0x%05X\n", blink1, blink2,
		ilink1, ilink2);

}

#define EVENT_START_OFFSET  (4 * sizeof(u32))

/**
 * iwl_print_event_log - Dump error event log to syslog
 *
 */
W
Wey-Yi Guy 已提交
1831 1832 1833
static int iwl_print_event_log(struct iwl_priv *priv, u32 start_idx,
			       u32 num_events, u32 mode,
			       int pos, char **buf, size_t bufsz)
1834 1835 1836 1837 1838 1839
{
	u32 i;
	u32 base;       /* SRAM byte address of event log header */
	u32 event_size; /* 2 u32s, or 3 u32s if timestamp recorded */
	u32 ptr;        /* SRAM byte address of log data */
	u32 ev, time, data; /* event log data */
B
Ben Cahill 已提交
1840
	unsigned long reg_flags;
1841 1842

	if (num_events == 0)
W
Wey-Yi Guy 已提交
1843
		return pos;
1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855
	if (priv->ucode_type == UCODE_INIT)
		base = le32_to_cpu(priv->card_alive_init.log_event_table_ptr);
	else
		base = le32_to_cpu(priv->card_alive.log_event_table_ptr);

	if (mode == 0)
		event_size = 2 * sizeof(u32);
	else
		event_size = 3 * sizeof(u32);

	ptr = base + EVENT_START_OFFSET + (start_idx * event_size);

B
Ben Cahill 已提交
1856 1857 1858 1859 1860 1861 1862 1863
	/* Make sure device is powered up for SRAM reads */
	spin_lock_irqsave(&priv->reg_lock, reg_flags);
	iwl_grab_nic_access(priv);

	/* Set starting address; reads will auto-increment */
	_iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
	rmb();

1864 1865 1866
	/* "time" is actually "data" for mode 0 (no timestamp).
	* place event id # at far right for easier visual parsing. */
	for (i = 0; i < num_events; i++) {
B
Ben Cahill 已提交
1867 1868
		ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
		time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
1869 1870
		if (mode == 0) {
			/* data, ev */
W
Wey-Yi Guy 已提交
1871 1872 1873 1874 1875 1876 1877 1878 1879 1880
			if (bufsz) {
				pos += scnprintf(*buf + pos, bufsz - pos,
						"EVT_LOG:0x%08x:%04u\n",
						time, ev);
			} else {
				trace_iwlwifi_dev_ucode_event(priv, 0,
					time, ev);
				IWL_ERR(priv, "EVT_LOG:0x%08x:%04u\n",
					time, ev);
			}
1881
		} else {
B
Ben Cahill 已提交
1882
			data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
W
Wey-Yi Guy 已提交
1883 1884 1885 1886 1887 1888
			if (bufsz) {
				pos += scnprintf(*buf + pos, bufsz - pos,
						"EVT_LOGT:%010u:0x%08x:%04u\n",
						 time, data, ev);
			} else {
				IWL_ERR(priv, "EVT_LOGT:%010u:0x%08x:%04u\n",
1889
					time, data, ev);
W
Wey-Yi Guy 已提交
1890 1891 1892
				trace_iwlwifi_dev_ucode_event(priv, time,
					data, ev);
			}
1893 1894
		}
	}
B
Ben Cahill 已提交
1895 1896 1897 1898

	/* Allow device to power down */
	iwl_release_nic_access(priv);
	spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
W
Wey-Yi Guy 已提交
1899
	return pos;
1900 1901
}

1902 1903 1904
/**
 * iwl_print_last_event_logs - Dump the newest # of event log to syslog
 */
W
Wey-Yi Guy 已提交
1905 1906 1907 1908
static int iwl_print_last_event_logs(struct iwl_priv *priv, u32 capacity,
				    u32 num_wraps, u32 next_entry,
				    u32 size, u32 mode,
				    int pos, char **buf, size_t bufsz)
1909 1910 1911 1912 1913 1914 1915
{
	/*
	 * display the newest DEFAULT_LOG_ENTRIES entries
	 * i.e the entries just before the next ont that uCode would fill.
	 */
	if (num_wraps) {
		if (next_entry < size) {
W
Wey-Yi Guy 已提交
1916 1917 1918 1919 1920 1921 1922
			pos = iwl_print_event_log(priv,
						capacity - (size - next_entry),
						size - next_entry, mode,
						pos, buf, bufsz);
			pos = iwl_print_event_log(priv, 0,
						  next_entry, mode,
						  pos, buf, bufsz);
1923
		} else
W
Wey-Yi Guy 已提交
1924 1925
			pos = iwl_print_event_log(priv, next_entry - size,
						  size, mode, pos, buf, bufsz);
1926
	} else {
W
Wey-Yi Guy 已提交
1927 1928 1929 1930 1931 1932 1933
		if (next_entry < size) {
			pos = iwl_print_event_log(priv, 0, next_entry,
						  mode, pos, buf, bufsz);
		} else {
			pos = iwl_print_event_log(priv, next_entry - size,
						  size, mode, pos, buf, bufsz);
		}
1934
	}
W
Wey-Yi Guy 已提交
1935
	return pos;
1936 1937
}

B
Ben Cahill 已提交
1938 1939 1940
/* For sanity check only.  Actual size is determined by uCode, typ. 512 */
#define MAX_EVENT_LOG_SIZE (512)

1941 1942
#define DEFAULT_DUMP_EVENT_LOG_ENTRIES (20)

W
Wey-Yi Guy 已提交
1943 1944
int iwl_dump_nic_event_log(struct iwl_priv *priv, bool full_log,
			    char **buf, bool display)
1945 1946 1947 1948 1949 1950 1951
{
	u32 base;       /* SRAM byte address of event log header */
	u32 capacity;   /* event log capacity in # entries */
	u32 mode;       /* 0 - no timestamp, 1 - timestamp recorded */
	u32 num_wraps;  /* # times uCode wrapped to top of log */
	u32 next_entry; /* index of next entry to be written by uCode */
	u32 size;       /* # entries that we'll print */
W
Wey-Yi Guy 已提交
1952 1953
	int pos = 0;
	size_t bufsz = 0;
1954 1955 1956 1957 1958 1959 1960

	if (priv->ucode_type == UCODE_INIT)
		base = le32_to_cpu(priv->card_alive_init.log_event_table_ptr);
	else
		base = le32_to_cpu(priv->card_alive.log_event_table_ptr);

	if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
1961 1962 1963
		IWL_ERR(priv,
			"Invalid event log pointer 0x%08X for %s uCode\n",
			base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
1964
		return -EINVAL;
1965 1966 1967 1968 1969 1970 1971 1972
	}

	/* event log header */
	capacity = iwl_read_targ_mem(priv, base);
	mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
	num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
	next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));

B
Ben Cahill 已提交
1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984
	if (capacity > MAX_EVENT_LOG_SIZE) {
		IWL_ERR(priv, "Log capacity %d is bogus, limit to %d entries\n",
			capacity, MAX_EVENT_LOG_SIZE);
		capacity = MAX_EVENT_LOG_SIZE;
	}

	if (next_entry > MAX_EVENT_LOG_SIZE) {
		IWL_ERR(priv, "Log write index %d is bogus, limit to %d\n",
			next_entry, MAX_EVENT_LOG_SIZE);
		next_entry = MAX_EVENT_LOG_SIZE;
	}

1985 1986 1987 1988 1989
	size = num_wraps ? capacity : next_entry;

	/* bail out if nothing in log */
	if (size == 0) {
		IWL_ERR(priv, "Start IWL Event Log Dump: nothing in log\n");
W
Wey-Yi Guy 已提交
1990
		return pos;
1991 1992
	}

1993
#ifdef CONFIG_IWLWIFI_DEBUG
1994
	if (!(iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) && !full_log)
1995 1996 1997 1998 1999 2000 2001 2002
		size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
			? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
#else
	size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
		? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
#endif
	IWL_ERR(priv, "Start IWL Event Log Dump: display last %u entries\n",
		size);
2003

2004
#ifdef CONFIG_IWLWIFI_DEBUG
W
Wey-Yi Guy 已提交
2005 2006 2007 2008 2009 2010 2011
	if (display) {
		if (full_log)
			bufsz = capacity * 48;
		else
			bufsz = size * 48;
		*buf = kmalloc(bufsz, GFP_KERNEL);
		if (!*buf)
2012
			return -ENOMEM;
W
Wey-Yi Guy 已提交
2013
	}
2014 2015 2016 2017 2018 2019 2020
	if ((iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) || full_log) {
		/*
		 * if uCode has wrapped back to top of log,
		 * start at the oldest entry,
		 * i.e the next one that uCode would fill.
		 */
		if (num_wraps)
W
Wey-Yi Guy 已提交
2021 2022 2023
			pos = iwl_print_event_log(priv, next_entry,
						capacity - next_entry, mode,
						pos, buf, bufsz);
2024
		/* (then/else) start at top of log */
W
Wey-Yi Guy 已提交
2025 2026
		pos = iwl_print_event_log(priv, 0,
					  next_entry, mode, pos, buf, bufsz);
2027
	} else
W
Wey-Yi Guy 已提交
2028 2029 2030
		pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
						next_entry, size, mode,
						pos, buf, bufsz);
2031
#else
W
Wey-Yi Guy 已提交
2032 2033 2034
	pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
					next_entry, size, mode,
					pos, buf, bufsz);
2035
#endif
W
Wey-Yi Guy 已提交
2036
	return pos;
2037
}
2038

Z
Zhu Yi 已提交
2039
/**
2040
 * iwl_alive_start - called after REPLY_ALIVE notification received
Z
Zhu Yi 已提交
2041
 *                   from protocol/runtime uCode (initialization uCode's
2042
 *                   Alive gets handled by iwl_init_alive_start()).
Z
Zhu Yi 已提交
2043
 */
2044
static void iwl_alive_start(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2045
{
2046
	int ret = 0;
Z
Zhu Yi 已提交
2047

2048
	IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
Z
Zhu Yi 已提交
2049 2050 2051 2052

	if (priv->card_alive.is_valid != UCODE_VALID_OK) {
		/* We had an error bringing up the hardware, so take it
		 * all the way back down so we can try again */
2053
		IWL_DEBUG_INFO(priv, "Alive failed.\n");
Z
Zhu Yi 已提交
2054 2055 2056 2057 2058 2059
		goto restart;
	}

	/* Initialize uCode has loaded Runtime uCode ... verify inst image.
	 * This is a paranoid check, because we would not have gotten the
	 * "runtime" alive if code weren't properly loaded.  */
2060
	if (iwl_verify_ucode(priv)) {
Z
Zhu Yi 已提交
2061 2062
		/* Runtime instruction load was bad;
		 * take it all the way back down so we can try again */
2063
		IWL_DEBUG_INFO(priv, "Bad runtime uCode load.\n");
Z
Zhu Yi 已提交
2064 2065 2066
		goto restart;
	}

2067 2068
	ret = priv->cfg->ops->lib->alive_notify(priv);
	if (ret) {
2069 2070
		IWL_WARN(priv,
			"Could not complete ALIVE transition [ntf]: %d\n", ret);
Z
Zhu Yi 已提交
2071 2072 2073
		goto restart;
	}

2074
	/* After the ALIVE response, we can send host commands to the uCode */
Z
Zhu Yi 已提交
2075 2076
	set_bit(STATUS_ALIVE, &priv->status);

2077 2078 2079 2080 2081 2082 2083
	if (priv->cfg->ops->lib->recover_from_tx_stall) {
		/* Enable timer to monitor the driver queues */
		mod_timer(&priv->monitor_recover,
			jiffies +
			msecs_to_jiffies(priv->cfg->monitor_recover_period));
	}

2084
	if (iwl_is_rfkill(priv))
Z
Zhu Yi 已提交
2085 2086
		return;

2087
	ieee80211_wake_queues(priv->hw);
Z
Zhu Yi 已提交
2088

2089
	priv->active_rate = IWL_RATES_MASK;
Z
Zhu Yi 已提交
2090

2091 2092 2093 2094
	/* Configure Tx antenna selection based on H/W config */
	if (priv->cfg->ops->hcmd->set_tx_ant)
		priv->cfg->ops->hcmd->set_tx_ant(priv, priv->cfg->valid_tx_ant);

2095
	if (iwl_is_associated(priv)) {
G
Gregory Greenman 已提交
2096 2097
		struct iwl_rxon_cmd *active_rxon =
				(struct iwl_rxon_cmd *)&priv->active_rxon;
2098 2099
		/* apply any changes in staging */
		priv->staging_rxon.filter_flags |= RXON_FILTER_ASSOC_MSK;
Z
Zhu Yi 已提交
2100 2101 2102
		active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
	} else {
		/* Initialize our rx_config data */
2103
		iwl_connection_init_rx_config(priv, priv->iw_mode);
2104 2105 2106 2107

		if (priv->cfg->ops->hcmd->set_rxon_chain)
			priv->cfg->ops->hcmd->set_rxon_chain(priv);

Z
Zhu Yi 已提交
2108 2109 2110
		memcpy(priv->staging_rxon.node_addr, priv->mac_addr, ETH_ALEN);
	}

2111
	/* Configure Bluetooth device coexistence support */
2112
	iwl_send_bt_config(priv);
Z
Zhu Yi 已提交
2113

2114 2115
	iwl_reset_run_time_calib(priv);

Z
Zhu Yi 已提交
2116
	/* Configure the adapter for unassociated operation */
A
Abhijeet Kolekar 已提交
2117
	iwlcore_commit_rxon(priv);
Z
Zhu Yi 已提交
2118 2119

	/* At this point, the NIC is initialized and operational */
2120
	iwl_rf_kill_ct_config(priv);
2121

J
Johannes Berg 已提交
2122
	iwl_leds_init(priv);
2123

2124
	IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
2125
	set_bit(STATUS_READY, &priv->status);
2126
	wake_up_interruptible(&priv->wait_command_queue);
Z
Zhu Yi 已提交
2127

2128
	iwl_power_update_mode(priv, true);
2129 2130
	IWL_DEBUG_INFO(priv, "Updated power mode\n");

2131

Z
Zhu Yi 已提交
2132 2133 2134 2135 2136 2137
	return;

 restart:
	queue_work(priv->workqueue, &priv->restart);
}

2138
static void iwl_cancel_deferred_work(struct iwl_priv *priv);
Z
Zhu Yi 已提交
2139

2140
static void __iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2141 2142 2143 2144
{
	unsigned long flags;
	int exit_pending = test_bit(STATUS_EXIT_PENDING, &priv->status);

2145
	IWL_DEBUG_INFO(priv, DRV_NAME " is going down\n");
Z
Zhu Yi 已提交
2146 2147 2148 2149

	if (!exit_pending)
		set_bit(STATUS_EXIT_PENDING, &priv->status);

2150
	iwl_clear_ucode_stations(priv, true);
Z
Zhu Yi 已提交
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160

	/* Unblock any waiting calls */
	wake_up_interruptible_all(&priv->wait_command_queue);

	/* Wipe out the EXIT_PENDING status bit if we are not actually
	 * exiting the module */
	if (!exit_pending)
		clear_bit(STATUS_EXIT_PENDING, &priv->status);

	/* stop and reset the on-board processor */
2161
	iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
Z
Zhu Yi 已提交
2162 2163

	/* tell the device to stop sending interrupts */
2164
	spin_lock_irqsave(&priv->lock, flags);
2165
	iwl_disable_interrupts(priv);
2166 2167
	spin_unlock_irqrestore(&priv->lock, flags);
	iwl_synchronize_irq(priv);
Z
Zhu Yi 已提交
2168 2169 2170 2171

	if (priv->mac80211_registered)
		ieee80211_stop_queues(priv->hw);

2172
	/* If we have not previously called iwl_init() then
J
Johannes Berg 已提交
2173
	 * clear all bits but the RF Kill bit and return */
2174
	if (!iwl_is_init(priv)) {
Z
Zhu Yi 已提交
2175 2176
		priv->status = test_bit(STATUS_RF_KILL_HW, &priv->status) <<
					STATUS_RF_KILL_HW |
2177 2178
			       test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
					STATUS_GEO_CONFIGURED |
2179 2180
			       test_bit(STATUS_EXIT_PENDING, &priv->status) <<
					STATUS_EXIT_PENDING;
Z
Zhu Yi 已提交
2181 2182 2183
		goto exit;
	}

2184
	/* ...otherwise clear out all the status bits but the RF Kill
J
Johannes Berg 已提交
2185
	 * bit and continue taking the NIC down. */
Z
Zhu Yi 已提交
2186 2187
	priv->status &= test_bit(STATUS_RF_KILL_HW, &priv->status) <<
				STATUS_RF_KILL_HW |
2188 2189
			test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
				STATUS_GEO_CONFIGURED |
Z
Zhu Yi 已提交
2190
			test_bit(STATUS_FW_ERROR, &priv->status) <<
2191 2192 2193
				STATUS_FW_ERROR |
		       test_bit(STATUS_EXIT_PENDING, &priv->status) <<
				STATUS_EXIT_PENDING;
Z
Zhu Yi 已提交
2194

M
Mohamed Abbas 已提交
2195 2196
	/* device going down, Stop using ICT table */
	iwl_disable_ict(priv);
Z
Zhu Yi 已提交
2197

2198
	iwl_txq_ctx_stop(priv);
2199
	iwl_rxq_stop(priv);
Z
Zhu Yi 已提交
2200

B
Ben Cahill 已提交
2201 2202
	/* Power-down device's busmaster DMA clocks */
	iwl_write_prph(priv, APMG_CLK_DIS_REG, APMG_CLK_VAL_DMA_CLK_RQT);
Z
Zhu Yi 已提交
2203 2204
	udelay(5);

B
Ben Cahill 已提交
2205 2206 2207
	/* Make sure (redundant) we've released our request to stay awake */
	iwl_clear_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);

2208 2209 2210
	/* Stop the device, and put it in low power state */
	priv->cfg->ops->lib->apm_ops.stop(priv);

Z
Zhu Yi 已提交
2211
 exit:
2212
	memset(&priv->card_alive, 0, sizeof(struct iwl_alive_resp));
Z
Zhu Yi 已提交
2213 2214 2215 2216 2217 2218

	if (priv->ibss_beacon)
		dev_kfree_skb(priv->ibss_beacon);
	priv->ibss_beacon = NULL;

	/* clear out any free frames */
2219
	iwl_clear_free_frames(priv);
Z
Zhu Yi 已提交
2220 2221
}

2222
static void iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2223 2224
{
	mutex_lock(&priv->mutex);
2225
	__iwl_down(priv);
Z
Zhu Yi 已提交
2226
	mutex_unlock(&priv->mutex);
2227

2228
	iwl_cancel_deferred_work(priv);
Z
Zhu Yi 已提交
2229 2230
}

M
Mohamed Abbas 已提交
2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260
#define HW_READY_TIMEOUT (50)

static int iwl_set_hw_ready(struct iwl_priv *priv)
{
	int ret = 0;

	iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
		CSR_HW_IF_CONFIG_REG_BIT_NIC_READY);

	/* See if we got it */
	ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
				CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
				CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
				HW_READY_TIMEOUT);
	if (ret != -ETIMEDOUT)
		priv->hw_ready = true;
	else
		priv->hw_ready = false;

	IWL_DEBUG_INFO(priv, "hardware %s\n",
		      (priv->hw_ready == 1) ? "ready" : "not ready");
	return ret;
}

static int iwl_prepare_card_hw(struct iwl_priv *priv)
{
	int ret = 0;

	IWL_DEBUG_INFO(priv, "iwl_prepare_card_hw enter \n");

2261 2262 2263 2264 2265
	ret = iwl_set_hw_ready(priv);
	if (priv->hw_ready)
		return ret;

	/* If HW is not ready, prepare the conditions to check again */
M
Mohamed Abbas 已提交
2266 2267 2268 2269 2270 2271 2272
	iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
			CSR_HW_IF_CONFIG_REG_PREPARE);

	ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
			~CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE,
			CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE, 150000);

2273
	/* HW should be ready by now, check again. */
M
Mohamed Abbas 已提交
2274 2275 2276 2277 2278 2279
	if (ret != -ETIMEDOUT)
		iwl_set_hw_ready(priv);

	return ret;
}

Z
Zhu Yi 已提交
2280 2281
#define MAX_HW_RESTARTS 5

2282
static int __iwl_up(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2283
{
2284 2285
	int i;
	int ret;
Z
Zhu Yi 已提交
2286 2287

	if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
2288
		IWL_WARN(priv, "Exit pending; will not bring the NIC up\n");
Z
Zhu Yi 已提交
2289 2290 2291
		return -EIO;
	}

2292
	if (!priv->ucode_data_backup.v_addr || !priv->ucode_data.v_addr) {
2293
		IWL_ERR(priv, "ucode not available for device bringup\n");
2294 2295 2296
		return -EIO;
	}

M
Mohamed Abbas 已提交
2297 2298 2299 2300 2301 2302 2303
	iwl_prepare_card_hw(priv);

	if (!priv->hw_ready) {
		IWL_WARN(priv, "Exit HW not ready\n");
		return -EIO;
	}

2304
	/* If platform's RF_KILL switch is NOT set to KILL */
2305
	if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
2306
		clear_bit(STATUS_RF_KILL_HW, &priv->status);
2307
	else
2308
		set_bit(STATUS_RF_KILL_HW, &priv->status);
2309

2310
	if (iwl_is_rfkill(priv)) {
J
Johannes Berg 已提交
2311 2312
		wiphy_rfkill_set_hw_state(priv->hw->wiphy, true);

2313
		iwl_enable_interrupts(priv);
J
Johannes Berg 已提交
2314
		IWL_WARN(priv, "Radio disabled by HW RF Kill switch\n");
2315
		return 0;
Z
Zhu Yi 已提交
2316 2317
	}

2318
	iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
Z
Zhu Yi 已提交
2319

2320
	ret = iwl_hw_nic_init(priv);
2321
	if (ret) {
2322
		IWL_ERR(priv, "Unable to init nic\n");
2323
		return ret;
Z
Zhu Yi 已提交
2324 2325 2326
	}

	/* make sure rfkill handshake bits are cleared */
2327 2328
	iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
	iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
Z
Zhu Yi 已提交
2329 2330 2331
		    CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);

	/* clear (again), then enable host interrupts */
2332
	iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
2333
	iwl_enable_interrupts(priv);
Z
Zhu Yi 已提交
2334 2335

	/* really make sure rfkill handshake bits are cleared */
2336 2337
	iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
	iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
Z
Zhu Yi 已提交
2338 2339 2340 2341 2342

	/* Copy original ucode data image from disk into backup cache.
	 * This will be used to initialize the on-board processor's
	 * data SRAM for a clean start when the runtime program first loads. */
	memcpy(priv->ucode_data_backup.v_addr, priv->ucode_data.v_addr,
2343
	       priv->ucode_data.len);
Z
Zhu Yi 已提交
2344 2345 2346 2347 2348 2349

	for (i = 0; i < MAX_HW_RESTARTS; i++) {

		/* load bootstrap state machine,
		 * load bootstrap program into processor's memory,
		 * prepare to load the "initialize" uCode */
2350
		ret = priv->cfg->ops->lib->load_ucode(priv);
Z
Zhu Yi 已提交
2351

2352
		if (ret) {
2353 2354
			IWL_ERR(priv, "Unable to set up bootstrap uCode: %d\n",
				ret);
Z
Zhu Yi 已提交
2355 2356 2357 2358
			continue;
		}

		/* start card; "initialize" will load runtime ucode */
2359
		iwl_nic_start(priv);
Z
Zhu Yi 已提交
2360

2361
		IWL_DEBUG_INFO(priv, DRV_NAME " is coming up\n");
Z
Zhu Yi 已提交
2362 2363 2364 2365 2366

		return 0;
	}

	set_bit(STATUS_EXIT_PENDING, &priv->status);
2367
	__iwl_down(priv);
M
Mohamed Abbas 已提交
2368
	clear_bit(STATUS_EXIT_PENDING, &priv->status);
Z
Zhu Yi 已提交
2369 2370 2371

	/* tried to restart and config the device for as long as our
	 * patience could withstand */
2372
	IWL_ERR(priv, "Unable to initialize device after %d attempts.\n", i);
Z
Zhu Yi 已提交
2373 2374 2375 2376 2377 2378 2379 2380 2381 2382
	return -EIO;
}


/*****************************************************************************
 *
 * Workqueue callbacks
 *
 *****************************************************************************/

2383
static void iwl_bg_init_alive_start(struct work_struct *data)
Z
Zhu Yi 已提交
2384
{
2385 2386
	struct iwl_priv *priv =
	    container_of(data, struct iwl_priv, init_alive_start.work);
Z
Zhu Yi 已提交
2387 2388 2389 2390 2391

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

	mutex_lock(&priv->mutex);
2392
	priv->cfg->ops->lib->init_alive_start(priv);
Z
Zhu Yi 已提交
2393 2394 2395
	mutex_unlock(&priv->mutex);
}

2396
static void iwl_bg_alive_start(struct work_struct *data)
Z
Zhu Yi 已提交
2397
{
2398 2399
	struct iwl_priv *priv =
	    container_of(data, struct iwl_priv, alive_start.work);
Z
Zhu Yi 已提交
2400 2401 2402 2403

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

M
Mohamed Abbas 已提交
2404 2405 2406
	/* enable dram interrupt */
	iwl_reset_ict(priv);

Z
Zhu Yi 已提交
2407
	mutex_lock(&priv->mutex);
2408
	iwl_alive_start(priv);
Z
Zhu Yi 已提交
2409 2410 2411
	mutex_unlock(&priv->mutex);
}

2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434
static void iwl_bg_run_time_calib_work(struct work_struct *work)
{
	struct iwl_priv *priv = container_of(work, struct iwl_priv,
			run_time_calib_work);

	mutex_lock(&priv->mutex);

	if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
	    test_bit(STATUS_SCANNING, &priv->status)) {
		mutex_unlock(&priv->mutex);
		return;
	}

	if (priv->start_calib) {
		iwl_chain_noise_calibration(priv, &priv->statistics);

		iwl_sensitivity_calibration(priv, &priv->statistics);
	}

	mutex_unlock(&priv->mutex);
	return;
}

2435
static void iwl_bg_restart(struct work_struct *data)
Z
Zhu Yi 已提交
2436
{
2437
	struct iwl_priv *priv = container_of(data, struct iwl_priv, restart);
Z
Zhu Yi 已提交
2438 2439 2440 2441

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

J
Johannes Berg 已提交
2442 2443 2444 2445 2446 2447 2448 2449 2450
	if (test_and_clear_bit(STATUS_FW_ERROR, &priv->status)) {
		mutex_lock(&priv->mutex);
		priv->vif = NULL;
		priv->is_open = 0;
		mutex_unlock(&priv->mutex);
		iwl_down(priv);
		ieee80211_restart_hw(priv->hw);
	} else {
		iwl_down(priv);
J
Johannes Berg 已提交
2451 2452 2453 2454 2455 2456 2457

		if (test_bit(STATUS_EXIT_PENDING, &priv->status))
			return;

		mutex_lock(&priv->mutex);
		__iwl_up(priv);
		mutex_unlock(&priv->mutex);
J
Johannes Berg 已提交
2458
	}
Z
Zhu Yi 已提交
2459 2460
}

2461
static void iwl_bg_rx_replenish(struct work_struct *data)
Z
Zhu Yi 已提交
2462
{
2463 2464
	struct iwl_priv *priv =
	    container_of(data, struct iwl_priv, rx_replenish);
Z
Zhu Yi 已提交
2465 2466 2467 2468 2469

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;

	mutex_lock(&priv->mutex);
2470
	iwl_rx_replenish(priv);
Z
Zhu Yi 已提交
2471 2472 2473
	mutex_unlock(&priv->mutex);
}

2474 2475
#define IWL_DELAY_NEXT_SCAN (HZ*2)

2476
void iwl_post_associate(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2477 2478
{
	struct ieee80211_conf *conf = NULL;
2479
	int ret = 0;
2480
	unsigned long flags;
Z
Zhu Yi 已提交
2481

2482
	if (priv->iw_mode == NL80211_IFTYPE_AP) {
2483
		IWL_ERR(priv, "%s Should not be called in AP mode\n", __func__);
Z
Zhu Yi 已提交
2484 2485 2486 2487 2488 2489 2490
		return;
	}

	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
		return;


2491
	if (!priv->vif || !priv->is_open)
M
Mohamed Abbas 已提交
2492
		return;
2493

2494
	iwl_scan_cancel_timeout(priv, 200);
2495

Z
Zhu Yi 已提交
2496 2497 2498
	conf = ieee80211_get_hw_conf(priv->hw);

	priv->staging_rxon.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
A
Abhijeet Kolekar 已提交
2499
	iwlcore_commit_rxon(priv);
Z
Zhu Yi 已提交
2500

2501
	iwl_setup_rxon_timing(priv);
2502
	ret = iwl_send_cmd_pdu(priv, REPLY_RXON_TIMING,
Z
Zhu Yi 已提交
2503
			      sizeof(priv->rxon_timing), &priv->rxon_timing);
2504
	if (ret)
2505
		IWL_WARN(priv, "REPLY_RXON_TIMING failed - "
Z
Zhu Yi 已提交
2506 2507 2508 2509
			    "Attempting to continue.\n");

	priv->staging_rxon.filter_flags |= RXON_FILTER_ASSOC_MSK;

2510
	iwl_set_rxon_ht(priv, &priv->current_ht_config);
2511

2512 2513 2514
	if (priv->cfg->ops->hcmd->set_rxon_chain)
		priv->cfg->ops->hcmd->set_rxon_chain(priv);

Z
Zhu Yi 已提交
2515 2516
	priv->staging_rxon.assoc_id = cpu_to_le16(priv->assoc_id);

2517
	IWL_DEBUG_ASSOC(priv, "assoc id %d beacon interval %d\n",
Z
Zhu Yi 已提交
2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530
			priv->assoc_id, priv->beacon_int);

	if (priv->assoc_capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
		priv->staging_rxon.flags |= RXON_FLG_SHORT_PREAMBLE_MSK;
	else
		priv->staging_rxon.flags &= ~RXON_FLG_SHORT_PREAMBLE_MSK;

	if (priv->staging_rxon.flags & RXON_FLG_BAND_24G_MSK) {
		if (priv->assoc_capability & WLAN_CAPABILITY_SHORT_SLOT_TIME)
			priv->staging_rxon.flags |= RXON_FLG_SHORT_SLOT_MSK;
		else
			priv->staging_rxon.flags &= ~RXON_FLG_SHORT_SLOT_MSK;

2531
		if (priv->iw_mode == NL80211_IFTYPE_ADHOC)
Z
Zhu Yi 已提交
2532 2533 2534 2535
			priv->staging_rxon.flags &= ~RXON_FLG_SHORT_SLOT_MSK;

	}

A
Abhijeet Kolekar 已提交
2536
	iwlcore_commit_rxon(priv);
Z
Zhu Yi 已提交
2537

2538 2539 2540
	IWL_DEBUG_ASSOC(priv, "Associated as %d to: %pM\n",
			priv->assoc_id, priv->active_rxon.bssid_addr);

Z
Zhu Yi 已提交
2541
	switch (priv->iw_mode) {
2542
	case NL80211_IFTYPE_STATION:
Z
Zhu Yi 已提交
2543 2544
		break;

2545
	case NL80211_IFTYPE_ADHOC:
Z
Zhu Yi 已提交
2546

2547 2548
		/* assume default assoc id */
		priv->assoc_id = 1;
Z
Zhu Yi 已提交
2549

2550
		iwl_add_local_station(priv, priv->bssid, true);
2551
		iwl_send_beacon_cmd(priv);
Z
Zhu Yi 已提交
2552 2553 2554 2555

		break;

	default:
2556
		IWL_ERR(priv, "%s Should not be called in %d mode\n",
2557
			  __func__, priv->iw_mode);
Z
Zhu Yi 已提交
2558 2559 2560
		break;
	}

2561 2562 2563
	spin_lock_irqsave(&priv->lock, flags);
	iwl_activate_qos(priv, 0);
	spin_unlock_irqrestore(&priv->lock, flags);
2564

2565 2566 2567 2568
	/* the chain noise calibration will enabled PM upon completion
	 * If chain noise has already been run, then we need to enable
	 * power management here */
	if (priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE)
2569
		iwl_power_update_mode(priv, false);
2570 2571 2572 2573 2574

	/* Enable Rx differential gain and sensitivity calibrations */
	iwl_chain_noise_reset(priv);
	priv->start_calib = 1;

2575 2576
}

Z
Zhu Yi 已提交
2577 2578 2579 2580 2581 2582
/*****************************************************************************
 *
 * mac80211 entry point functions
 *
 *****************************************************************************/

2583
#define UCODE_READY_TIMEOUT	(4 * HZ)
2584

2585 2586 2587 2588
/*
 * Not a mac80211 entry point function, but it fits in with all the
 * other mac80211 functions grouped here.
 */
J
Johannes Berg 已提交
2589
static int iwl_mac_setup_register(struct iwl_priv *priv)
2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604
{
	int ret;
	struct ieee80211_hw *hw = priv->hw;
	hw->rate_control_algorithm = "iwl-agn-rs";

	/* Tell mac80211 our characteristics */
	hw->flags = IEEE80211_HW_SIGNAL_DBM |
		    IEEE80211_HW_NOISE_DBM |
		    IEEE80211_HW_AMPDU_AGGREGATION |
		    IEEE80211_HW_SPECTRUM_MGMT;

	if (!priv->cfg->broken_powersave)
		hw->flags |= IEEE80211_HW_SUPPORTS_PS |
			     IEEE80211_HW_SUPPORTS_DYNAMIC_PS;

J
Johannes Berg 已提交
2605 2606 2607 2608
	if (priv->cfg->sku & IWL_SKU_N)
		hw->flags |= IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS |
			     IEEE80211_HW_SUPPORTS_STATIC_SMPS;

2609
	hw->sta_data_size = sizeof(struct iwl_station_priv);
2610 2611 2612 2613
	hw->wiphy->interface_modes =
		BIT(NL80211_IFTYPE_STATION) |
		BIT(NL80211_IFTYPE_ADHOC);

J
Johannes Berg 已提交
2614 2615
	hw->wiphy->flags |= WIPHY_FLAG_STRICT_REGULATORY |
			    WIPHY_FLAG_DISABLE_BEACON_HINTS;
2616 2617 2618 2619 2620

	/*
	 * For now, disable PS by default because it affects
	 * RX performance significantly.
	 */
J
Johannes Berg 已提交
2621
	hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
2622

2623
	hw->wiphy->max_scan_ssids = PROBE_OPTION_MAX + 1;
2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649
	/* we create the 802.11 header and a zero-length SSID element */
	hw->wiphy->max_scan_ie_len = IWL_MAX_PROBE_REQUEST - 24 - 2;

	/* Default value; 4 EDCA QOS priorities */
	hw->queues = 4;

	hw->max_listen_interval = IWL_CONN_MAX_LISTEN_INTERVAL;

	if (priv->bands[IEEE80211_BAND_2GHZ].n_channels)
		priv->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
			&priv->bands[IEEE80211_BAND_2GHZ];
	if (priv->bands[IEEE80211_BAND_5GHZ].n_channels)
		priv->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
			&priv->bands[IEEE80211_BAND_5GHZ];

	ret = ieee80211_register_hw(priv->hw);
	if (ret) {
		IWL_ERR(priv, "Failed to register hw (error %d)\n", ret);
		return ret;
	}
	priv->mac80211_registered = 1;

	return 0;
}


2650
static int iwl_mac_start(struct ieee80211_hw *hw)
Z
Zhu Yi 已提交
2651
{
2652
	struct iwl_priv *priv = hw->priv;
2653
	int ret;
Z
Zhu Yi 已提交
2654

2655
	IWL_DEBUG_MAC80211(priv, "enter\n");
Z
Zhu Yi 已提交
2656 2657 2658

	/* we should be verifying the device is ready to be opened */
	mutex_lock(&priv->mutex);
2659
	ret = __iwl_up(priv);
Z
Zhu Yi 已提交
2660
	mutex_unlock(&priv->mutex);
2661

2662
	if (ret)
2663
		return ret;
2664

2665 2666 2667
	if (iwl_is_rfkill(priv))
		goto out;

2668
	IWL_DEBUG_INFO(priv, "Start UP work done.\n");
2669

2670
	/* Wait for START_ALIVE from Run Time ucode. Otherwise callbacks from
2671
	 * mac80211 will not be run successfully. */
2672 2673 2674 2675 2676
	ret = wait_event_interruptible_timeout(priv->wait_command_queue,
			test_bit(STATUS_READY, &priv->status),
			UCODE_READY_TIMEOUT);
	if (!ret) {
		if (!test_bit(STATUS_READY, &priv->status)) {
2677
			IWL_ERR(priv, "START_ALIVE timeout after %dms.\n",
2678
				jiffies_to_msecs(UCODE_READY_TIMEOUT));
2679
			return -ETIMEDOUT;
2680
		}
2681
	}
T
Tomas Winkler 已提交
2682

J
Johannes Berg 已提交
2683 2684
	iwl_led_start(priv);

2685
out:
T
Tomas Winkler 已提交
2686
	priv->is_open = 1;
2687
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2688 2689 2690
	return 0;
}

2691
static void iwl_mac_stop(struct ieee80211_hw *hw)
Z
Zhu Yi 已提交
2692
{
2693
	struct iwl_priv *priv = hw->priv;
Z
Zhu Yi 已提交
2694

2695
	IWL_DEBUG_MAC80211(priv, "enter\n");
M
Mohamed Abbas 已提交
2696

J
Johannes Berg 已提交
2697
	if (!priv->is_open)
2698 2699
		return;

Z
Zhu Yi 已提交
2700
	priv->is_open = 0;
2701

2702
	if (iwl_is_ready_rf(priv) || test_bit(STATUS_SCAN_HW, &priv->status)) {
2703 2704 2705
		/* stop mac, cancel any scan request and clear
		 * RXON_FILTER_ASSOC_MSK BIT
		 */
2706
		mutex_lock(&priv->mutex);
2707
		iwl_scan_cancel_timeout(priv, 100);
2708 2709 2710
		mutex_unlock(&priv->mutex);
	}

2711
	iwl_down(priv);
2712 2713

	flush_workqueue(priv->workqueue);
2714 2715 2716 2717

	/* enable interrupts again in order to receive rfkill changes */
	iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
	iwl_enable_interrupts(priv);
M
Mohamed Abbas 已提交
2718

2719
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2720 2721
}

2722
static int iwl_mac_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
Z
Zhu Yi 已提交
2723
{
2724
	struct iwl_priv *priv = hw->priv;
Z
Zhu Yi 已提交
2725

2726
	IWL_DEBUG_MACDUMP(priv, "enter\n");
Z
Zhu Yi 已提交
2727

2728
	IWL_DEBUG_TX(priv, "dev->xmit(%d bytes) at rate 0x%02x\n", skb->len,
2729
		     ieee80211_get_tx_rate(hw, IEEE80211_SKB_CB(skb))->bitrate);
Z
Zhu Yi 已提交
2730

2731
	if (iwl_tx_skb(priv, skb))
Z
Zhu Yi 已提交
2732 2733
		dev_kfree_skb_any(skb);

2734
	IWL_DEBUG_MACDUMP(priv, "leave\n");
2735
	return NETDEV_TX_OK;
Z
Zhu Yi 已提交
2736 2737
}

A
Abhijeet Kolekar 已提交
2738
void iwl_config_ap(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2739
{
2740
	int ret = 0;
2741
	unsigned long flags;
Z
Zhu Yi 已提交
2742

2743
	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
Z
Zhu Yi 已提交
2744 2745 2746
		return;

	/* The following should be done only at AP bring up */
2747
	if (!iwl_is_associated(priv)) {
Z
Zhu Yi 已提交
2748 2749 2750

		/* RXON - unassoc (to set timing command) */
		priv->staging_rxon.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
A
Abhijeet Kolekar 已提交
2751
		iwlcore_commit_rxon(priv);
Z
Zhu Yi 已提交
2752 2753

		/* RXON Timing */
2754
		iwl_setup_rxon_timing(priv);
2755
		ret = iwl_send_cmd_pdu(priv, REPLY_RXON_TIMING,
Z
Zhu Yi 已提交
2756
				sizeof(priv->rxon_timing), &priv->rxon_timing);
2757
		if (ret)
2758
			IWL_WARN(priv, "REPLY_RXON_TIMING failed - "
Z
Zhu Yi 已提交
2759 2760
					"Attempting to continue.\n");

2761 2762 2763 2764
		/* AP has all antennas */
		priv->chain_noise_data.active_chains =
			priv->hw_params.valid_rx_ant;
		iwl_set_rxon_ht(priv, &priv->current_ht_config);
2765 2766
		if (priv->cfg->ops->hcmd->set_rxon_chain)
			priv->cfg->ops->hcmd->set_rxon_chain(priv);
Z
Zhu Yi 已提交
2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785

		/* FIXME: what should be the assoc_id for AP? */
		priv->staging_rxon.assoc_id = cpu_to_le16(priv->assoc_id);
		if (priv->assoc_capability & WLAN_CAPABILITY_SHORT_PREAMBLE)
			priv->staging_rxon.flags |=
				RXON_FLG_SHORT_PREAMBLE_MSK;
		else
			priv->staging_rxon.flags &=
				~RXON_FLG_SHORT_PREAMBLE_MSK;

		if (priv->staging_rxon.flags & RXON_FLG_BAND_24G_MSK) {
			if (priv->assoc_capability &
				WLAN_CAPABILITY_SHORT_SLOT_TIME)
				priv->staging_rxon.flags |=
					RXON_FLG_SHORT_SLOT_MSK;
			else
				priv->staging_rxon.flags &=
					~RXON_FLG_SHORT_SLOT_MSK;

2786
			if (priv->iw_mode == NL80211_IFTYPE_ADHOC)
Z
Zhu Yi 已提交
2787 2788 2789 2790 2791
				priv->staging_rxon.flags &=
					~RXON_FLG_SHORT_SLOT_MSK;
		}
		/* restore RXON assoc */
		priv->staging_rxon.filter_flags |= RXON_FILTER_ASSOC_MSK;
A
Abhijeet Kolekar 已提交
2792
		iwlcore_commit_rxon(priv);
2793
		iwl_reset_qos(priv);
2794 2795 2796
		spin_lock_irqsave(&priv->lock, flags);
		iwl_activate_qos(priv, 1);
		spin_unlock_irqrestore(&priv->lock, flags);
2797
		iwl_add_bcast_station(priv);
2798
	}
2799
	iwl_send_beacon_cmd(priv);
Z
Zhu Yi 已提交
2800 2801 2802 2803 2804 2805

	/* FIXME - we need to add code here to detect a totally new
	 * configuration, reset the AP, unassoc, rxon timing, assoc,
	 * clear sta table, add BCAST sta... */
}

2806
static void iwl_mac_update_tkip_key(struct ieee80211_hw *hw,
2807 2808 2809 2810
				    struct ieee80211_vif *vif,
				    struct ieee80211_key_conf *keyconf,
				    struct ieee80211_sta *sta,
				    u32 iv32, u16 *phase1key)
2811 2812
{

2813
	struct iwl_priv *priv = hw->priv;
2814
	IWL_DEBUG_MAC80211(priv, "enter\n");
2815

2816 2817 2818
	iwl_update_tkip_key(priv, keyconf,
			    sta ? sta->addr : iwl_bcast_addr,
			    iv32, phase1key);
2819

2820
	IWL_DEBUG_MAC80211(priv, "leave\n");
2821 2822
}

2823
static int iwl_mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
2824 2825
			   struct ieee80211_vif *vif,
			   struct ieee80211_sta *sta,
Z
Zhu Yi 已提交
2826 2827
			   struct ieee80211_key_conf *key)
{
2828
	struct iwl_priv *priv = hw->priv;
2829 2830 2831 2832
	const u8 *addr;
	int ret;
	u8 sta_id;
	bool is_default_wep_key = false;
Z
Zhu Yi 已提交
2833

2834
	IWL_DEBUG_MAC80211(priv, "enter\n");
Z
Zhu Yi 已提交
2835

2836
	if (priv->cfg->mod_params->sw_crypto) {
2837
		IWL_DEBUG_MAC80211(priv, "leave - hwcrypto disabled\n");
Z
Zhu Yi 已提交
2838 2839
		return -EOPNOTSUPP;
	}
2840
	addr = sta ? sta->addr : iwl_bcast_addr;
2841
	sta_id = iwl_find_station(priv, addr);
2842
	if (sta_id == IWL_INVALID_STATION) {
2843
		IWL_DEBUG_MAC80211(priv, "leave - %pM not in station map.\n",
J
Johannes Berg 已提交
2844
				   addr);
2845
		return -EINVAL;
Z
Zhu Yi 已提交
2846

2847
	}
Z
Zhu Yi 已提交
2848

2849
	mutex_lock(&priv->mutex);
2850
	iwl_scan_cancel_timeout(priv, 100);
2851 2852 2853 2854 2855

	/* If we are getting WEP group key and we didn't receive any key mapping
	 * so far, we are in legacy wep mode (group key only), otherwise we are
	 * in 1X mode.
	 * In legacy wep mode, we use another host command to the uCode */
T
Tomas Winkler 已提交
2856
	if (key->alg == ALG_WEP && sta_id == priv->hw_params.bcast_sta_id &&
2857
		priv->iw_mode != NL80211_IFTYPE_AP) {
2858 2859 2860
		if (cmd == SET_KEY)
			is_default_wep_key = !priv->key_mapping_key;
		else
2861 2862
			is_default_wep_key =
					(key->hw_key_idx == HW_KEY_DEFAULT);
2863
	}
2864

Z
Zhu Yi 已提交
2865
	switch (cmd) {
2866
	case SET_KEY:
2867 2868
		if (is_default_wep_key)
			ret = iwl_set_default_wep_key(priv, key);
2869
		else
2870
			ret = iwl_set_dynamic_key(priv, key, sta_id);
2871

2872
		IWL_DEBUG_MAC80211(priv, "enable hwcrypto key\n");
Z
Zhu Yi 已提交
2873 2874
		break;
	case DISABLE_KEY:
2875 2876
		if (is_default_wep_key)
			ret = iwl_remove_default_wep_key(priv, key);
2877
		else
2878
			ret = iwl_remove_dynamic_key(priv, key, sta_id);
2879

2880
		IWL_DEBUG_MAC80211(priv, "disable hwcrypto key\n");
Z
Zhu Yi 已提交
2881 2882
		break;
	default:
2883
		ret = -EINVAL;
Z
Zhu Yi 已提交
2884 2885
	}

2886
	mutex_unlock(&priv->mutex);
2887
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2888

2889
	return ret;
Z
Zhu Yi 已提交
2890 2891
}

2892
static int iwl_mac_ampdu_action(struct ieee80211_hw *hw,
2893
				struct ieee80211_vif *vif,
2894
			     enum ieee80211_ampdu_mlme_action action,
2895
			     struct ieee80211_sta *sta, u16 tid, u16 *ssn)
2896 2897
{
	struct iwl_priv *priv = hw->priv;
2898
	int ret;
2899

2900
	IWL_DEBUG_HT(priv, "A-MPDU action on addr %pM tid %d\n",
J
Johannes Berg 已提交
2901
		     sta->addr, tid);
2902 2903 2904 2905 2906 2907

	if (!(priv->cfg->sku & IWL_SKU_N))
		return -EACCES;

	switch (action) {
	case IEEE80211_AMPDU_RX_START:
2908
		IWL_DEBUG_HT(priv, "start Rx\n");
2909
		return iwl_sta_rx_agg_start(priv, sta->addr, tid, *ssn);
2910
	case IEEE80211_AMPDU_RX_STOP:
2911
		IWL_DEBUG_HT(priv, "stop Rx\n");
2912 2913 2914 2915 2916
		ret = iwl_sta_rx_agg_stop(priv, sta->addr, tid);
		if (test_bit(STATUS_EXIT_PENDING, &priv->status))
			return 0;
		else
			return ret;
2917
	case IEEE80211_AMPDU_TX_START:
2918
		IWL_DEBUG_HT(priv, "start Tx\n");
2919
		return iwl_tx_agg_start(priv, sta->addr, tid, ssn);
2920
	case IEEE80211_AMPDU_TX_STOP:
2921
		IWL_DEBUG_HT(priv, "stop Tx\n");
2922 2923 2924 2925 2926
		ret = iwl_tx_agg_stop(priv, sta->addr, tid);
		if (test_bit(STATUS_EXIT_PENDING, &priv->status))
			return 0;
		else
			return ret;
2927 2928 2929
	case IEEE80211_AMPDU_TX_OPERATIONAL:
		/* do nothing */
		return -EOPNOTSUPP;
2930
	default:
2931
		IWL_DEBUG_HT(priv, "unknown\n");
2932 2933 2934 2935 2936
		return -EINVAL;
		break;
	}
	return 0;
}
2937

2938
static int iwl_mac_get_stats(struct ieee80211_hw *hw,
Z
Zhu Yi 已提交
2939 2940
			     struct ieee80211_low_level_stats *stats)
{
2941 2942 2943
	struct iwl_priv *priv = hw->priv;

	priv = hw->priv;
2944 2945
	IWL_DEBUG_MAC80211(priv, "enter\n");
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2946 2947 2948 2949

	return 0;
}

2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967
static void iwl_mac_sta_notify(struct ieee80211_hw *hw,
			       struct ieee80211_vif *vif,
			       enum sta_notify_cmd cmd,
			       struct ieee80211_sta *sta)
{
	struct iwl_priv *priv = hw->priv;
	struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
	int sta_id;

	switch (cmd) {
	case STA_NOTIFY_SLEEP:
		WARN_ON(!sta_priv->client);
		sta_priv->asleep = true;
		if (atomic_read(&sta_priv->pending_frames) > 0)
			ieee80211_sta_block_awake(hw, sta, true);
		break;
	case STA_NOTIFY_AWAKE:
		WARN_ON(!sta_priv->client);
D
Daniel Halperin 已提交
2968 2969
		if (!sta_priv->asleep)
			break;
2970 2971 2972 2973 2974 2975 2976 2977 2978 2979
		sta_priv->asleep = false;
		sta_id = iwl_find_station(priv, sta->addr);
		if (sta_id != IWL_INVALID_STATION)
			iwl_sta_modify_ps_wake(priv, sta_id);
		break;
	default:
		break;
	}
}

2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028
/**
 * iwl_restore_wepkeys - Restore WEP keys to device
 */
static void iwl_restore_wepkeys(struct iwl_priv *priv)
{
	mutex_lock(&priv->mutex);
	if (priv->iw_mode == NL80211_IFTYPE_STATION &&
	    priv->default_wep_key &&
	    iwl_send_static_wepkey_cmd(priv, 0))
		IWL_ERR(priv, "Could not send WEP static key\n");
	mutex_unlock(&priv->mutex);
}

static int iwlagn_mac_sta_add(struct ieee80211_hw *hw,
			      struct ieee80211_vif *vif,
			      struct ieee80211_sta *sta)
{
	struct iwl_priv *priv = hw->priv;
	struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
	bool is_ap = priv->iw_mode == NL80211_IFTYPE_STATION;
	int ret;
	u8 sta_id;

	IWL_DEBUG_INFO(priv, "received request to add station %pM\n",
			sta->addr);

	atomic_set(&sta_priv->pending_frames, 0);
	if (vif->type == NL80211_IFTYPE_AP)
		sta_priv->client = true;

	ret = iwl_add_station_common(priv, sta->addr, is_ap, &sta->ht_cap,
				     &sta_id);
	if (ret) {
		IWL_ERR(priv, "Unable to add station %pM (%d)\n",
			sta->addr, ret);
		/* Should we return success if return code is EEXIST ? */
		return ret;
	}

	iwl_restore_wepkeys(priv);

	/* Initialize rate scaling */
	IWL_DEBUG_INFO(priv, "Initializing rate scaling for station %pM \n",
		       sta->addr);
	iwl_rs_rate_init(priv, sta, sta_id);

	return ret;
}

Z
Zhu Yi 已提交
3029 3030 3031 3032 3033 3034
/*****************************************************************************
 *
 * sysfs attributes
 *
 *****************************************************************************/

3035
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
3036 3037 3038

/*
 * The following adds a new attribute to the sysfs representation
3039
 * of this device driver (i.e. a new file in /sys/class/net/wlan0/device/)
Z
Zhu Yi 已提交
3040 3041 3042
 * used for controlling the debug level.
 *
 * See the level definitions in iwl for details.
3043
 *
3044 3045 3046
 * The debug_level being managed using sysfs below is a per device debug
 * level that is used instead of the global debug level if it (the per
 * device debug level) is set.
Z
Zhu Yi 已提交
3047
 */
3048 3049
static ssize_t show_debug_level(struct device *d,
				struct device_attribute *attr, char *buf)
Z
Zhu Yi 已提交
3050
{
3051 3052
	struct iwl_priv *priv = dev_get_drvdata(d);
	return sprintf(buf, "0x%08X\n", iwl_get_debug_level(priv));
Z
Zhu Yi 已提交
3053
}
3054 3055
static ssize_t store_debug_level(struct device *d,
				struct device_attribute *attr,
Z
Zhu Yi 已提交
3056 3057
				 const char *buf, size_t count)
{
3058
	struct iwl_priv *priv = dev_get_drvdata(d);
3059 3060
	unsigned long val;
	int ret;
Z
Zhu Yi 已提交
3061

3062 3063
	ret = strict_strtoul(buf, 0, &val);
	if (ret)
T
Tomas Winkler 已提交
3064
		IWL_ERR(priv, "%s is not in hex or decimal form.\n", buf);
3065
	else {
3066
		priv->debug_level = val;
3067 3068 3069 3070
		if (iwl_alloc_traffic_mem(priv))
			IWL_ERR(priv,
				"Not enough memory to generate traffic log\n");
	}
Z
Zhu Yi 已提交
3071 3072 3073
	return strnlen(buf, count);
}

3074 3075 3076
static DEVICE_ATTR(debug_level, S_IWUSR | S_IRUGO,
			show_debug_level, store_debug_level);

Z
Zhu Yi 已提交
3077

3078
#endif /* CONFIG_IWLWIFI_DEBUG */
Z
Zhu Yi 已提交
3079 3080 3081 3082 3083


static ssize_t show_temperature(struct device *d,
				struct device_attribute *attr, char *buf)
{
3084
	struct iwl_priv *priv = dev_get_drvdata(d);
Z
Zhu Yi 已提交
3085

3086
	if (!iwl_is_alive(priv))
Z
Zhu Yi 已提交
3087 3088
		return -EAGAIN;

3089
	return sprintf(buf, "%d\n", priv->temperature);
Z
Zhu Yi 已提交
3090 3091 3092 3093 3094 3095 3096
}

static DEVICE_ATTR(temperature, S_IRUGO, show_temperature, NULL);

static ssize_t show_tx_power(struct device *d,
			     struct device_attribute *attr, char *buf)
{
3097
	struct iwl_priv *priv = dev_get_drvdata(d);
3098 3099 3100 3101 3102

	if (!iwl_is_ready_rf(priv))
		return sprintf(buf, "off\n");
	else
		return sprintf(buf, "%d\n", priv->tx_power_user_lmt);
Z
Zhu Yi 已提交
3103 3104 3105 3106 3107 3108
}

static ssize_t store_tx_power(struct device *d,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
{
3109
	struct iwl_priv *priv = dev_get_drvdata(d);
3110 3111
	unsigned long val;
	int ret;
Z
Zhu Yi 已提交
3112

3113 3114
	ret = strict_strtoul(buf, 10, &val);
	if (ret)
T
Tomas Winkler 已提交
3115
		IWL_INFO(priv, "%s is not in decimal form.\n", buf);
3116 3117 3118 3119 3120 3121 3122 3123 3124
	else {
		ret = iwl_set_tx_power(priv, val, false);
		if (ret)
			IWL_ERR(priv, "failed setting tx power (0x%d).\n",
				ret);
		else
			ret = count;
	}
	return ret;
Z
Zhu Yi 已提交
3125 3126 3127 3128 3129 3130 3131
}

static DEVICE_ATTR(tx_power, S_IWUSR | S_IRUGO, show_tx_power, store_tx_power);

static ssize_t show_statistics(struct device *d,
			       struct device_attribute *attr, char *buf)
{
3132
	struct iwl_priv *priv = dev_get_drvdata(d);
3133
	u32 size = sizeof(struct iwl_notif_statistics);
Z
Zhu Yi 已提交
3134
	u32 len = 0, ofs = 0;
3135
	u8 *data = (u8 *)&priv->statistics;
Z
Zhu Yi 已提交
3136 3137
	int rc = 0;

3138
	if (!iwl_is_alive(priv))
Z
Zhu Yi 已提交
3139 3140 3141
		return -EAGAIN;

	mutex_lock(&priv->mutex);
3142
	rc = iwl_send_statistics_request(priv, CMD_SYNC, false);
Z
Zhu Yi 已提交
3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166
	mutex_unlock(&priv->mutex);

	if (rc) {
		len = sprintf(buf,
			      "Error sending statistics request: 0x%08X\n", rc);
		return len;
	}

	while (size && (PAGE_SIZE - len)) {
		hex_dump_to_buffer(data + ofs, size, 16, 1, buf + len,
				   PAGE_SIZE - len, 1);
		len = strlen(buf);
		if (PAGE_SIZE - len)
			buf[len++] = '\n';

		ofs += 16;
		size -= min(size, 16U);
	}

	return len;
}

static DEVICE_ATTR(statistics, S_IRUGO, show_statistics, NULL);

3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200
static ssize_t show_rts_ht_protection(struct device *d,
			     struct device_attribute *attr, char *buf)
{
	struct iwl_priv *priv = dev_get_drvdata(d);

	return sprintf(buf, "%s\n",
		priv->cfg->use_rts_for_ht ? "RTS/CTS" : "CTS-to-self");
}

static ssize_t store_rts_ht_protection(struct device *d,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
{
	struct iwl_priv *priv = dev_get_drvdata(d);
	unsigned long val;
	int ret;

	ret = strict_strtoul(buf, 10, &val);
	if (ret)
		IWL_INFO(priv, "Input is not in decimal form.\n");
	else {
		if (!iwl_is_associated(priv))
			priv->cfg->use_rts_for_ht = val ? true : false;
		else
			IWL_ERR(priv, "Sta associated with AP - "
				"Change protection mechanism is not allowed\n");
		ret = count;
	}
	return ret;
}

static DEVICE_ATTR(rts_ht_protection, S_IWUSR | S_IRUGO,
			show_rts_ht_protection, store_rts_ht_protection);

Z
Zhu Yi 已提交
3201 3202 3203 3204 3205 3206 3207

/*****************************************************************************
 *
 * driver setup and teardown
 *
 *****************************************************************************/

3208
static void iwl_setup_deferred_work(struct iwl_priv *priv)
Z
Zhu Yi 已提交
3209
{
3210
	priv->workqueue = create_singlethread_workqueue(DRV_NAME);
Z
Zhu Yi 已提交
3211 3212 3213

	init_waitqueue_head(&priv->wait_command_queue);

3214 3215 3216
	INIT_WORK(&priv->restart, iwl_bg_restart);
	INIT_WORK(&priv->rx_replenish, iwl_bg_rx_replenish);
	INIT_WORK(&priv->beacon_update, iwl_bg_beacon_update);
3217
	INIT_WORK(&priv->run_time_calib_work, iwl_bg_run_time_calib_work);
3218 3219
	INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
	INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
3220 3221

	iwl_setup_scan_deferred_work(priv);
C
Christoph Hellwig 已提交
3222

3223 3224 3225 3226 3227
	if (priv->cfg->ops->lib->setup_deferred_work)
		priv->cfg->ops->lib->setup_deferred_work(priv);

	init_timer(&priv->statistics_periodic);
	priv->statistics_periodic.data = (unsigned long)priv;
3228
	priv->statistics_periodic.function = iwl_bg_statistics_periodic;
Z
Zhu Yi 已提交
3229

3230 3231 3232 3233
	init_timer(&priv->ucode_trace);
	priv->ucode_trace.data = (unsigned long)priv;
	priv->ucode_trace.function = iwl_bg_ucode_trace;

3234 3235 3236 3237 3238 3239 3240
	if (priv->cfg->ops->lib->recover_from_tx_stall) {
		init_timer(&priv->monitor_recover);
		priv->monitor_recover.data = (unsigned long)priv;
		priv->monitor_recover.function =
			priv->cfg->ops->lib->recover_from_tx_stall;
	}

M
Mohamed Abbas 已提交
3241 3242 3243 3244 3245 3246
	if (!priv->cfg->use_isr_legacy)
		tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
			iwl_irq_tasklet, (unsigned long)priv);
	else
		tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
			iwl_irq_tasklet_legacy, (unsigned long)priv);
Z
Zhu Yi 已提交
3247 3248
}

3249
static void iwl_cancel_deferred_work(struct iwl_priv *priv)
Z
Zhu Yi 已提交
3250
{
3251 3252
	if (priv->cfg->ops->lib->cancel_deferred_work)
		priv->cfg->ops->lib->cancel_deferred_work(priv);
Z
Zhu Yi 已提交
3253

3254
	cancel_delayed_work_sync(&priv->init_alive_start);
Z
Zhu Yi 已提交
3255 3256 3257
	cancel_delayed_work(&priv->scan_check);
	cancel_delayed_work(&priv->alive_start);
	cancel_work_sync(&priv->beacon_update);
3258
	del_timer_sync(&priv->statistics_periodic);
3259
	del_timer_sync(&priv->ucode_trace);
3260 3261
	if (priv->cfg->ops->lib->recover_from_tx_stall)
		del_timer_sync(&priv->monitor_recover);
Z
Zhu Yi 已提交
3262 3263
}

3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296
static void iwl_init_hw_rates(struct iwl_priv *priv,
			      struct ieee80211_rate *rates)
{
	int i;

	for (i = 0; i < IWL_RATE_COUNT_LEGACY; i++) {
		rates[i].bitrate = iwl_rates[i].ieee * 5;
		rates[i].hw_value = i; /* Rate scaling will work on indexes */
		rates[i].hw_value_short = i;
		rates[i].flags = 0;
		if ((i >= IWL_FIRST_CCK_RATE) && (i <= IWL_LAST_CCK_RATE)) {
			/*
			 * If CCK != 1M then set short preamble rate flag.
			 */
			rates[i].flags |=
				(iwl_rates[i].plcp == IWL_RATE_1M_PLCP) ?
					0 : IEEE80211_RATE_SHORT_PREAMBLE;
		}
	}
}

static int iwl_init_drv(struct iwl_priv *priv)
{
	int ret;

	priv->ibss_beacon = NULL;

	spin_lock_init(&priv->sta_lock);
	spin_lock_init(&priv->hcmd_lock);

	INIT_LIST_HEAD(&priv->free_frames);

	mutex_init(&priv->mutex);
3297
	mutex_init(&priv->sync_cmd_mutex);
3298 3299 3300 3301 3302 3303

	priv->ieee_channels = NULL;
	priv->ieee_rates = NULL;
	priv->band = IEEE80211_BAND_2GHZ;

	priv->iw_mode = NL80211_IFTYPE_STATION;
J
Johannes Berg 已提交
3304
	priv->current_ht_config.smps = IEEE80211_SMPS_STATIC;
3305
	priv->missed_beacon_threshold = IWL_MISSED_BEACON_THRESHOLD_DEF;
3306

3307 3308 3309 3310 3311
	/* initialize force reset */
	priv->force_reset[IWL_RF_RESET].reset_duration =
		IWL_DELAY_NEXT_FORCE_RF_RESET;
	priv->force_reset[IWL_FW_RESET].reset_duration =
		IWL_DELAY_NEXT_FORCE_FW_RELOAD;
3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357

	/* Choose which receivers/antennas to use */
	if (priv->cfg->ops->hcmd->set_rxon_chain)
		priv->cfg->ops->hcmd->set_rxon_chain(priv);

	iwl_init_scan_params(priv);

	iwl_reset_qos(priv);

	priv->qos_data.qos_active = 0;
	priv->qos_data.qos_cap.val = 0;

	/* Set the tx_power_user_lmt to the lowest power level
	 * this value will get overwritten by channel max power avg
	 * from eeprom */
	priv->tx_power_user_lmt = IWL_TX_POWER_TARGET_POWER_MIN;

	ret = iwl_init_channel_map(priv);
	if (ret) {
		IWL_ERR(priv, "initializing regulatory failed: %d\n", ret);
		goto err;
	}

	ret = iwlcore_init_geos(priv);
	if (ret) {
		IWL_ERR(priv, "initializing geos failed: %d\n", ret);
		goto err_free_channel_map;
	}
	iwl_init_hw_rates(priv, priv->ieee_rates);

	return 0;

err_free_channel_map:
	iwl_free_channel_map(priv);
err:
	return ret;
}

static void iwl_uninit_drv(struct iwl_priv *priv)
{
	iwl_calib_free_results(priv);
	iwlcore_free_geos(priv);
	iwl_free_channel_map(priv);
	kfree(priv->scan);
}

3358
static struct attribute *iwl_sysfs_entries[] = {
Z
Zhu Yi 已提交
3359 3360 3361
	&dev_attr_statistics.attr,
	&dev_attr_temperature.attr,
	&dev_attr_tx_power.attr,
3362
	&dev_attr_rts_ht_protection.attr,
3363 3364 3365
#ifdef CONFIG_IWLWIFI_DEBUG
	&dev_attr_debug_level.attr,
#endif
Z
Zhu Yi 已提交
3366 3367 3368
	NULL
};

3369
static struct attribute_group iwl_attribute_group = {
Z
Zhu Yi 已提交
3370
	.name = NULL,		/* put in device directory */
3371
	.attrs = iwl_sysfs_entries,
Z
Zhu Yi 已提交
3372 3373
};

3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388
static struct ieee80211_ops iwl_hw_ops = {
	.tx = iwl_mac_tx,
	.start = iwl_mac_start,
	.stop = iwl_mac_stop,
	.add_interface = iwl_mac_add_interface,
	.remove_interface = iwl_mac_remove_interface,
	.config = iwl_mac_config,
	.configure_filter = iwl_configure_filter,
	.set_key = iwl_mac_set_key,
	.update_tkip_key = iwl_mac_update_tkip_key,
	.get_stats = iwl_mac_get_stats,
	.conf_tx = iwl_mac_conf_tx,
	.reset_tsf = iwl_mac_reset_tsf,
	.bss_info_changed = iwl_bss_info_changed,
	.ampdu_action = iwl_mac_ampdu_action,
3389 3390
	.hw_scan = iwl_mac_hw_scan,
	.sta_notify = iwl_mac_sta_notify,
3391 3392
	.sta_add = iwlagn_mac_sta_add,
	.sta_remove = iwl_mac_sta_remove,
Z
Zhu Yi 已提交
3393 3394
};

3395
static int iwl_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
Z
Zhu Yi 已提交
3396 3397
{
	int err = 0;
3398
	struct iwl_priv *priv;
Z
Zhu Yi 已提交
3399
	struct ieee80211_hw *hw;
T
Tomas Winkler 已提交
3400
	struct iwl_cfg *cfg = (struct iwl_cfg *)(ent->driver_data);
3401
	unsigned long flags;
3402
	u16 pci_cmd;
Z
Zhu Yi 已提交
3403

3404 3405 3406 3407
	/************************
	 * 1. Allocating HW data
	 ************************/

3408 3409
	/* Disabling hardware scan means that mac80211 will perform scans
	 * "the hard way", rather than using device's scan. */
3410
	if (cfg->mod_params->disable_hw_scan) {
3411
		if (iwl_debug_level & IWL_DL_INFO)
3412 3413
			dev_printk(KERN_DEBUG, &(pdev->dev),
				   "Disabling hw_scan\n");
3414
		iwl_hw_ops.hw_scan = NULL;
Z
Zhu Yi 已提交
3415 3416
	}

3417
	hw = iwl_alloc_all(cfg, &iwl_hw_ops);
3418
	if (!hw) {
Z
Zhu Yi 已提交
3419 3420 3421
		err = -ENOMEM;
		goto out;
	}
3422 3423 3424
	priv = hw->priv;
	/* At this point both hw and priv are allocated. */

Z
Zhu Yi 已提交
3425 3426
	SET_IEEE80211_DEV(hw, &pdev->dev);

3427
	IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
T
Tomas Winkler 已提交
3428
	priv->cfg = cfg;
Z
Zhu Yi 已提交
3429
	priv->pci_dev = pdev;
3430
	priv->inta_mask = CSR_INI_SET_MASK;
3431

3432
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
3433 3434
	atomic_set(&priv->restrict_refcnt, 0);
#endif
3435 3436
	if (iwl_alloc_traffic_mem(priv))
		IWL_ERR(priv, "Not enough memory to generate traffic log\n");
Z
Zhu Yi 已提交
3437

3438 3439 3440 3441 3442 3443 3444 3445 3446 3447
	/**************************
	 * 2. Initializing PCI bus
	 **************************/
	if (pci_enable_device(pdev)) {
		err = -ENODEV;
		goto out_ieee80211_free_hw;
	}

	pci_set_master(pdev);

W
Winkler, Tomas 已提交
3448
	err = pci_set_dma_mask(pdev, DMA_BIT_MASK(36));
3449
	if (!err)
W
Winkler, Tomas 已提交
3450
		err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(36));
3451
	if (err) {
W
Winkler, Tomas 已提交
3452
		err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
3453
		if (!err)
W
Winkler, Tomas 已提交
3454
			err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
3455
		/* both attempts failed: */
3456
		if (err) {
T
Tomas Winkler 已提交
3457
			IWL_WARN(priv, "No suitable DMA available.\n");
3458
			goto out_pci_disable_device;
3459
		}
3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477
	}

	err = pci_request_regions(pdev, DRV_NAME);
	if (err)
		goto out_pci_disable_device;

	pci_set_drvdata(pdev, priv);


	/***********************
	 * 3. Read REV register
	 ***********************/
	priv->hw_base = pci_iomap(pdev, 0, 0);
	if (!priv->hw_base) {
		err = -ENODEV;
		goto out_pci_release_regions;
	}

3478
	IWL_DEBUG_INFO(priv, "pci_resource_len = 0x%08llx\n",
3479
		(unsigned long long) pci_resource_len(pdev, 0));
3480
	IWL_DEBUG_INFO(priv, "pci_resource_base = %p\n", priv->hw_base);
3481

3482
	/* these spin locks will be used in apm_ops.init and EEPROM access
M
Mohamed Abbas 已提交
3483 3484 3485
	 * we should init now
	 */
	spin_lock_init(&priv->reg_lock);
3486
	spin_lock_init(&priv->lock);
3487 3488 3489 3490 3491 3492 3493 3494

	/*
	 * stop and reset the on-board processor just in case it is in a
	 * strange state ... like being left stranded by a primary kernel
	 * and this is now the kdump kernel trying to start up
	 */
	iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);

3495
	iwl_hw_detect(priv);
3496
	IWL_INFO(priv, "Detected %s, REV=0x%X\n",
3497
		priv->cfg->name, priv->hw_rev);
3498

3499 3500 3501 3502
	/* We disable the RETRY_TIMEOUT register (0x41) to keep
	 * PCI Tx retries from interfering with C3 CPU state */
	pci_write_config_byte(pdev, PCI_CFG_RETRY_TIMEOUT, 0x00);

M
Mohamed Abbas 已提交
3503 3504 3505 3506 3507 3508
	iwl_prepare_card_hw(priv);
	if (!priv->hw_ready) {
		IWL_WARN(priv, "Failed, HW not ready\n");
		goto out_iounmap;
	}

T
Tomas Winkler 已提交
3509 3510 3511
	/*****************
	 * 4. Read EEPROM
	 *****************/
3512 3513 3514
	/* Read the EEPROM */
	err = iwl_eeprom_init(priv);
	if (err) {
3515
		IWL_ERR(priv, "Unable to init EEPROM\n");
3516 3517
		goto out_iounmap;
	}
3518 3519
	err = iwl_eeprom_check_version(priv);
	if (err)
3520
		goto out_free_eeprom;
3521

3522
	/* extract MAC Address */
3523
	iwl_eeprom_get_mac(priv, priv->mac_addr);
3524
	IWL_DEBUG_INFO(priv, "MAC address: %pM\n", priv->mac_addr);
3525 3526 3527 3528 3529
	SET_IEEE80211_PERM_ADDR(priv->hw, priv->mac_addr);

	/************************
	 * 5. Setup HW constants
	 ************************/
3530
	if (iwl_set_hw_params(priv)) {
3531
		IWL_ERR(priv, "failed to set hw parameters\n");
3532
		goto out_free_eeprom;
3533 3534 3535
	}

	/*******************
T
Tomas Winkler 已提交
3536
	 * 6. Setup priv
3537
	 *******************/
Z
Zhu Yi 已提交
3538

T
Tomas Winkler 已提交
3539
	err = iwl_init_drv(priv);
3540
	if (err)
R
Ron Rindjunsky 已提交
3541
		goto out_free_eeprom;
3542
	/* At this point both hw and priv are initialized. */
3543 3544

	/********************
3545
	 * 7. Setup services
3546
	 ********************/
3547
	spin_lock_irqsave(&priv->lock, flags);
3548
	iwl_disable_interrupts(priv);
3549
	spin_unlock_irqrestore(&priv->lock, flags);
3550

3551 3552
	pci_enable_msi(priv->pci_dev);

M
Mohamed Abbas 已提交
3553 3554 3555
	iwl_alloc_isr_ict(priv);
	err = request_irq(priv->pci_dev->irq, priv->cfg->ops->lib->isr,
			  IRQF_SHARED, DRV_NAME, priv);
3556 3557 3558 3559
	if (err) {
		IWL_ERR(priv, "Error allocating IRQ %d\n", priv->pci_dev->irq);
		goto out_disable_msi;
	}
3560
	err = sysfs_create_group(&pdev->dev.kobj, &iwl_attribute_group);
3561
	if (err) {
3562
		IWL_ERR(priv, "failed to create sysfs device attributes\n");
3563
		goto out_free_irq;
3564 3565
	}

3566
	iwl_setup_deferred_work(priv);
3567
	iwl_setup_rx_handlers(priv);
3568

J
Johannes Berg 已提交
3569 3570 3571
	/*********************************************
	 * 8. Enable interrupts and read RFKILL state
	 *********************************************/
T
Tomas Winkler 已提交
3572

3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586
	/* enable interrupts if needed: hw bug w/a */
	pci_read_config_word(priv->pci_dev, PCI_COMMAND, &pci_cmd);
	if (pci_cmd & PCI_COMMAND_INTX_DISABLE) {
		pci_cmd &= ~PCI_COMMAND_INTX_DISABLE;
		pci_write_config_word(priv->pci_dev, PCI_COMMAND, pci_cmd);
	}

	iwl_enable_interrupts(priv);

	/* If platform's RF_KILL switch is NOT set to KILL */
	if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
		clear_bit(STATUS_RF_KILL_HW, &priv->status);
	else
		set_bit(STATUS_RF_KILL_HW, &priv->status);
T
Tomas Winkler 已提交
3587

J
Johannes Berg 已提交
3588 3589
	wiphy_rfkill_set_hw_state(priv->hw->wiphy,
		test_bit(STATUS_RF_KILL_HW, &priv->status));
3590

3591
	iwl_power_initialize(priv);
3592
	iwl_tt_initialize(priv);
J
Johannes Berg 已提交
3593

3594
	err = iwl_request_firmware(priv, true);
J
Johannes Berg 已提交
3595 3596 3597
	if (err)
		goto out_remove_sysfs;

Z
Zhu Yi 已提交
3598 3599
	return 0;

3600
 out_remove_sysfs:
3601 3602
	destroy_workqueue(priv->workqueue);
	priv->workqueue = NULL;
3603
	sysfs_remove_group(&pdev->dev.kobj, &iwl_attribute_group);
3604 3605
 out_free_irq:
	free_irq(priv->pci_dev->irq, priv);
M
Mohamed Abbas 已提交
3606
	iwl_free_isr_ict(priv);
3607 3608
 out_disable_msi:
	pci_disable_msi(priv->pci_dev);
T
Tomas Winkler 已提交
3609
	iwl_uninit_drv(priv);
3610 3611
 out_free_eeprom:
	iwl_eeprom_free(priv);
Z
Zhu Yi 已提交
3612 3613 3614
 out_iounmap:
	pci_iounmap(pdev, priv->hw_base);
 out_pci_release_regions:
3615
	pci_set_drvdata(pdev, NULL);
3616
	pci_release_regions(pdev);
Z
Zhu Yi 已提交
3617 3618 3619
 out_pci_disable_device:
	pci_disable_device(pdev);
 out_ieee80211_free_hw:
3620
	iwl_free_traffic_mem(priv);
3621
	ieee80211_free_hw(priv->hw);
Z
Zhu Yi 已提交
3622 3623 3624 3625
 out:
	return err;
}

3626
static void __devexit iwl_pci_remove(struct pci_dev *pdev)
Z
Zhu Yi 已提交
3627
{
3628
	struct iwl_priv *priv = pci_get_drvdata(pdev);
3629
	unsigned long flags;
Z
Zhu Yi 已提交
3630 3631 3632 3633

	if (!priv)
		return;

3634
	IWL_DEBUG_INFO(priv, "*** UNLOAD DRIVER ***\n");
Z
Zhu Yi 已提交
3635

3636
	iwl_dbgfs_unregister(priv);
3637
	sysfs_remove_group(&pdev->dev.kobj, &iwl_attribute_group);
3638

3639 3640
	/* ieee80211_unregister_hw call wil cause iwl_mac_stop to
	 * to be called and iwl_down since we are removing the device
3641 3642 3643
	 * we need to set STATUS_EXIT_PENDING bit.
	 */
	set_bit(STATUS_EXIT_PENDING, &priv->status);
3644 3645 3646
	if (priv->mac80211_registered) {
		ieee80211_unregister_hw(priv->hw);
		priv->mac80211_registered = 0;
3647
	} else {
3648
		iwl_down(priv);
3649 3650
	}

3651 3652 3653 3654 3655 3656 3657 3658 3659
	/*
	 * Make sure device is reset to low power before unloading driver.
	 * This may be redundant with iwl_down(), but there are paths to
	 * run iwl_down() without calling apm_ops.stop(), and there are
	 * paths to avoid running iwl_down() at all before leaving driver.
	 * This (inexpensive) call *makes sure* device is reset.
	 */
	priv->cfg->ops->lib->apm_ops.stop(priv);

3660 3661
	iwl_tt_exit(priv);

3662 3663 3664 3665
	/* make sure we flush any pending irq or
	 * tasklet for the driver
	 */
	spin_lock_irqsave(&priv->lock, flags);
3666
	iwl_disable_interrupts(priv);
3667 3668 3669 3670
	spin_unlock_irqrestore(&priv->lock, flags);

	iwl_synchronize_irq(priv);

3671
	iwl_dealloc_ucode_pci(priv);
Z
Zhu Yi 已提交
3672 3673

	if (priv->rxq.bd)
3674
		iwl_rx_queue_free(priv, &priv->rxq);
3675
	iwl_hw_txq_ctx_free(priv);
Z
Zhu Yi 已提交
3676

3677
	iwl_eeprom_free(priv);
Z
Zhu Yi 已提交
3678 3679


M
Mohamed Abbas 已提交
3680 3681 3682
	/*netif_stop_queue(dev); */
	flush_workqueue(priv->workqueue);

3683
	/* ieee80211_unregister_hw calls iwl_mac_stop, which flushes
Z
Zhu Yi 已提交
3684 3685 3686 3687
	 * priv->workqueue... so we can't take down the workqueue
	 * until now... */
	destroy_workqueue(priv->workqueue);
	priv->workqueue = NULL;
3688
	iwl_free_traffic_mem(priv);
Z
Zhu Yi 已提交
3689

3690 3691
	free_irq(priv->pci_dev->irq, priv);
	pci_disable_msi(priv->pci_dev);
Z
Zhu Yi 已提交
3692 3693 3694 3695 3696
	pci_iounmap(pdev, priv->hw_base);
	pci_release_regions(pdev);
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);

T
Tomas Winkler 已提交
3697
	iwl_uninit_drv(priv);
Z
Zhu Yi 已提交
3698

M
Mohamed Abbas 已提交
3699 3700
	iwl_free_isr_ict(priv);

Z
Zhu Yi 已提交
3701 3702 3703 3704 3705 3706 3707 3708 3709 3710 3711 3712 3713
	if (priv->ibss_beacon)
		dev_kfree_skb(priv->ibss_beacon);

	ieee80211_free_hw(priv->hw);
}


/*****************************************************************************
 *
 * driver and module entry point
 *
 *****************************************************************************/

3714
/* Hardware specific file defines the PCI IDs table for that hardware module */
3715
static DEFINE_PCI_DEVICE_TABLE(iwl_hw_card_ids) = {
T
Tomas Winkler 已提交
3716
#ifdef CONFIG_IWL4965
3717 3718
	{IWL_PCI_DEVICE(0x4229, PCI_ANY_ID, iwl4965_agn_cfg)},
	{IWL_PCI_DEVICE(0x4230, PCI_ANY_ID, iwl4965_agn_cfg)},
T
Tomas Winkler 已提交
3719
#endif /* CONFIG_IWL4965 */
3720
#ifdef CONFIG_IWL5000
3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777
/* 5100 Series WiFi */
	{IWL_PCI_DEVICE(0x4232, 0x1201, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1301, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1204, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1304, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1205, iwl5100_bgn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1305, iwl5100_bgn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1206, iwl5100_abg_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1306, iwl5100_abg_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1221, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1321, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1224, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1324, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1225, iwl5100_bgn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1325, iwl5100_bgn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1226, iwl5100_abg_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4232, 0x1326, iwl5100_abg_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1211, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1311, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1214, iwl5100_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1314, iwl5100_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1215, iwl5100_bgn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1315, iwl5100_bgn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1216, iwl5100_abg_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4237, 0x1316, iwl5100_abg_cfg)}, /* Half Mini Card */

/* 5300 Series WiFi */
	{IWL_PCI_DEVICE(0x4235, 0x1021, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1121, iwl5300_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1024, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1124, iwl5300_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1001, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1101, iwl5300_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1004, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4235, 0x1104, iwl5300_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4236, 0x1011, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4236, 0x1111, iwl5300_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x4236, 0x1014, iwl5300_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x4236, 0x1114, iwl5300_agn_cfg)}, /* Half Mini Card */

/* 5350 Series WiFi/WiMax */
	{IWL_PCI_DEVICE(0x423A, 0x1001, iwl5350_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423A, 0x1021, iwl5350_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423B, 0x1011, iwl5350_agn_cfg)}, /* Mini Card */

/* 5150 Series Wifi/WiMax */
	{IWL_PCI_DEVICE(0x423C, 0x1201, iwl5150_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423C, 0x1301, iwl5150_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x423C, 0x1206, iwl5150_abg_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423C, 0x1306, iwl5150_abg_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x423C, 0x1221, iwl5150_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423C, 0x1321, iwl5150_agn_cfg)}, /* Half Mini Card */

	{IWL_PCI_DEVICE(0x423D, 0x1211, iwl5150_agn_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423D, 0x1311, iwl5150_agn_cfg)}, /* Half Mini Card */
	{IWL_PCI_DEVICE(0x423D, 0x1216, iwl5150_abg_cfg)}, /* Mini Card */
	{IWL_PCI_DEVICE(0x423D, 0x1316, iwl5150_abg_cfg)}, /* Half Mini Card */
3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798

/* 6x00 Series */
	{IWL_PCI_DEVICE(0x422B, 0x1101, iwl6000_3agn_cfg)},
	{IWL_PCI_DEVICE(0x422B, 0x1121, iwl6000_3agn_cfg)},
	{IWL_PCI_DEVICE(0x422C, 0x1301, iwl6000i_2agn_cfg)},
	{IWL_PCI_DEVICE(0x422C, 0x1306, iwl6000i_2abg_cfg)},
	{IWL_PCI_DEVICE(0x422C, 0x1307, iwl6000i_2bg_cfg)},
	{IWL_PCI_DEVICE(0x422C, 0x1321, iwl6000i_2agn_cfg)},
	{IWL_PCI_DEVICE(0x422C, 0x1326, iwl6000i_2abg_cfg)},
	{IWL_PCI_DEVICE(0x4238, 0x1111, iwl6000_3agn_cfg)},
	{IWL_PCI_DEVICE(0x4239, 0x1311, iwl6000i_2agn_cfg)},
	{IWL_PCI_DEVICE(0x4239, 0x1316, iwl6000i_2abg_cfg)},

/* 6x50 WiFi/WiMax Series */
	{IWL_PCI_DEVICE(0x0087, 0x1301, iwl6050_2agn_cfg)},
	{IWL_PCI_DEVICE(0x0087, 0x1306, iwl6050_2abg_cfg)},
	{IWL_PCI_DEVICE(0x0087, 0x1321, iwl6050_2agn_cfg)},
	{IWL_PCI_DEVICE(0x0087, 0x1326, iwl6050_2abg_cfg)},
	{IWL_PCI_DEVICE(0x0089, 0x1311, iwl6050_2agn_cfg)},
	{IWL_PCI_DEVICE(0x0089, 0x1316, iwl6050_2abg_cfg)},

3799
/* 1000 Series WiFi */
3800 3801 3802 3803 3804 3805 3806 3807 3808 3809 3810 3811
	{IWL_PCI_DEVICE(0x0083, 0x1205, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1305, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1225, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1325, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0084, 0x1215, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0084, 0x1315, iwl1000_bgn_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1206, iwl1000_bg_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1306, iwl1000_bg_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1226, iwl1000_bg_cfg)},
	{IWL_PCI_DEVICE(0x0083, 0x1326, iwl1000_bg_cfg)},
	{IWL_PCI_DEVICE(0x0084, 0x1216, iwl1000_bg_cfg)},
	{IWL_PCI_DEVICE(0x0084, 0x1316, iwl1000_bg_cfg)},
3812
#endif /* CONFIG_IWL5000 */
T
Tomas Winkler 已提交
3813

3814 3815 3816 3817 3818
	{0}
};
MODULE_DEVICE_TABLE(pci, iwl_hw_card_ids);

static struct pci_driver iwl_driver = {
Z
Zhu Yi 已提交
3819
	.name = DRV_NAME,
3820
	.id_table = iwl_hw_card_ids,
3821 3822
	.probe = iwl_pci_probe,
	.remove = __devexit_p(iwl_pci_remove),
Z
Zhu Yi 已提交
3823
#ifdef CONFIG_PM
3824 3825
	.suspend = iwl_pci_suspend,
	.resume = iwl_pci_resume,
Z
Zhu Yi 已提交
3826 3827 3828
#endif
};

3829
static int __init iwl_init(void)
Z
Zhu Yi 已提交
3830 3831 3832 3833 3834
{

	int ret;
	printk(KERN_INFO DRV_NAME ": " DRV_DESCRIPTION ", " DRV_VERSION "\n");
	printk(KERN_INFO DRV_NAME ": " DRV_COPYRIGHT "\n");
3835

3836
	ret = iwlagn_rate_control_register();
3837
	if (ret) {
3838 3839
		printk(KERN_ERR DRV_NAME
		       "Unable to register rate control algorithm: %d\n", ret);
3840 3841 3842
		return ret;
	}

3843
	ret = pci_register_driver(&iwl_driver);
Z
Zhu Yi 已提交
3844
	if (ret) {
3845
		printk(KERN_ERR DRV_NAME "Unable to initialize PCI module\n");
3846
		goto error_register;
Z
Zhu Yi 已提交
3847 3848 3849
	}

	return ret;
3850 3851

error_register:
3852
	iwlagn_rate_control_unregister();
3853
	return ret;
Z
Zhu Yi 已提交
3854 3855
}

3856
static void __exit iwl_exit(void)
Z
Zhu Yi 已提交
3857
{
3858
	pci_unregister_driver(&iwl_driver);
3859
	iwlagn_rate_control_unregister();
Z
Zhu Yi 已提交
3860 3861
}

3862 3863
module_exit(iwl_exit);
module_init(iwl_init);
3864 3865

#ifdef CONFIG_IWLWIFI_DEBUG
3866
module_param_named(debug50, iwl_debug_level, uint, S_IRUGO);
3867
MODULE_PARM_DESC(debug50, "50XX debug output mask (deprecated)");
3868
module_param_named(debug, iwl_debug_level, uint, S_IRUGO | S_IWUSR);
3869 3870 3871
MODULE_PARM_DESC(debug, "debug output mask");
#endif