iwl-agn.c 94.0 KB
Newer Older
Z
Zhu Yi 已提交
1 2
/******************************************************************************
 *
W
Wey-Yi Guy 已提交
3
 * Copyright(c) 2003 - 2011 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
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 *****************************************************************************/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
32
#include <linux/slab.h>
Z
Zhu Yi 已提交
33 34
#include <linux/dma-mapping.h>
#include <linux/delay.h>
35
#include <linux/sched.h>
Z
Zhu Yi 已提交
36 37 38 39 40 41 42 43 44 45 46
#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>

A
Assaf Krauss 已提交
47
#include "iwl-eeprom.h"
48
#include "iwl-dev.h"
49
#include "iwl-core.h"
50
#include "iwl-io.h"
Z
Zhu Yi 已提交
51
#include "iwl-helpers.h"
52
#include "iwl-sta.h"
J
Johannes Berg 已提交
53
#include "iwl-agn-calib.h"
54
#include "iwl-agn.h"
55
#include "iwl-bus.h"
56
#include "iwl-trans.h"
57

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

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

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

75
#define DRV_VERSION     IWLWIFI_VERSION VD
Z
Zhu Yi 已提交
76 77 78 79


MODULE_DESCRIPTION(DRV_DESCRIPTION);
MODULE_VERSION(DRV_VERSION);
80
MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
Z
Zhu Yi 已提交
81 82
MODULE_LICENSE("GPL");

83
static int iwlagn_ant_coupling;
84
static bool iwlagn_bt_ch_announce = 1;
85

86
void iwl_update_chain_flags(struct iwl_priv *priv)
M
Mohamed Abbas 已提交
87
{
88
	struct iwl_rxon_context *ctx;
M
Mohamed Abbas 已提交
89

W
Wey-Yi Guy 已提交
90 91 92 93
	for_each_context(priv, ctx) {
		iwlagn_set_rxon_chain(priv, ctx);
		if (ctx->active.rx_chain != ctx->staging.rx_chain)
			iwlagn_commit_rxon(priv, ctx);
94
	}
M
Mohamed Abbas 已提交
95 96
}

97 98
/* 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,
99 100
			       struct iwl_tx_beacon_cmd *tx_beacon_cmd,
			       u8 *beacon, u32 frame_size)
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123
{
	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");
}

124
int iwlagn_send_beacon_cmd(struct iwl_priv *priv)
125 126
{
	struct iwl_tx_beacon_cmd *tx_beacon_cmd;
127 128
	struct iwl_host_cmd cmd = {
		.id = REPLY_TX_BEACON,
129
		.flags = CMD_SYNC,
130
	};
131
	struct ieee80211_tx_info *info;
132 133 134
	u32 frame_size;
	u32 rate_flags;
	u32 rate;
135

136 137 138 139
	/*
	 * We have to set up the TX command, the TX Beacon command, and the
	 * beacon contents.
	 */
140

141 142 143 144
	lockdep_assert_held(&priv->mutex);

	if (!priv->beacon_ctx) {
		IWL_ERR(priv, "trying to build beacon w/o beacon context!\n");
145
		return 0;
146 147
	}

148 149 150
	if (WARN_ON(!priv->beacon_skb))
		return -EINVAL;

151 152 153 154
	/* Allocate beacon command */
	if (!priv->beacon_cmd)
		priv->beacon_cmd = kzalloc(sizeof(*tx_beacon_cmd), GFP_KERNEL);
	tx_beacon_cmd = priv->beacon_cmd;
155 156 157 158
	if (!tx_beacon_cmd)
		return -ENOMEM;

	frame_size = priv->beacon_skb->len;
159

160
	/* Set up TX command fields */
161
	tx_beacon_cmd->tx.len = cpu_to_le16((u16)frame_size);
162
	tx_beacon_cmd->tx.sta_id = priv->beacon_ctx->bcast_sta_id;
163 164 165
	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;
166

167
	/* Set up TX beacon command fields */
168
	iwl_set_beacon_tim(priv, tx_beacon_cmd, priv->beacon_skb->data,
169
			   frame_size);
170

171
	/* Set up packet rate and flags */
172 173 174 175 176 177 178 179 180 181 182 183 184
	info = IEEE80211_SKB_CB(priv->beacon_skb);

	/*
	 * Let's set up the rate at least somewhat correctly;
	 * it will currently not actually be used by the uCode,
	 * it uses the broadcast station's rate instead.
	 */
	if (info->control.rates[0].idx < 0 ||
	    info->control.rates[0].flags & IEEE80211_TX_RC_MCS)
		rate = 0;
	else
		rate = info->control.rates[0].idx;

185 186
	priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant,
					      priv->hw_params.valid_tx_ant);
187
	rate_flags = iwl_ant_idx_to_flags(priv->mgmt_tx_ant);
188 189 190 191 192

	/* In mac80211, rates for 5 GHz start at 0 */
	if (info->band == IEEE80211_BAND_5GHZ)
		rate += IWL_FIRST_OFDM_RATE;
	else if (rate >= IWL_FIRST_CCK_RATE && rate <= IWL_LAST_CCK_RATE)
193
		rate_flags |= RATE_MCS_CCK_MSK;
194 195 196

	tx_beacon_cmd->tx.rate_n_flags =
			iwl_hw_set_rate_n_flags(rate, rate_flags);
197

198
	/* Submit command */
199
	cmd.len[0] = sizeof(*tx_beacon_cmd);
200
	cmd.data[0] = tx_beacon_cmd;
201 202 203 204
	cmd.dataflags[0] = IWL_HCMD_DFL_NOCOPY;
	cmd.len[1] = frame_size;
	cmd.data[1] = priv->beacon_skb->data;
	cmd.dataflags[1] = IWL_HCMD_DFL_NOCOPY;
205

206
	return trans_send_cmd(&priv->trans, &cmd);
207 208
}

209
static void iwl_bg_beacon_update(struct work_struct *work)
Z
Zhu Yi 已提交
210
{
211 212
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, beacon_update);
Z
Zhu Yi 已提交
213 214
	struct sk_buff *beacon;

215 216 217 218 219
	mutex_lock(&priv->mutex);
	if (!priv->beacon_ctx) {
		IWL_ERR(priv, "updating beacon w/o beacon context!\n");
		goto out;
	}
Z
Zhu Yi 已提交
220

221 222 223 224 225 226 227 228 229 230
	if (priv->beacon_ctx->vif->type != NL80211_IFTYPE_AP) {
		/*
		 * The ucode will send beacon notifications even in
		 * IBSS mode, but we don't want to process them. But
		 * we need to defer the type check to here due to
		 * requiring locking around the beacon_ctx access.
		 */
		goto out;
	}

231 232
	/* Pull updated AP beacon from mac80211. will fail if not in AP mode */
	beacon = ieee80211_beacon_get(priv->hw, priv->beacon_ctx->vif);
Z
Zhu Yi 已提交
233
	if (!beacon) {
234
		IWL_ERR(priv, "update beacon failed -- keeping old\n");
235
		goto out;
Z
Zhu Yi 已提交
236 237 238
	}

	/* new beacon skb is allocated every time; dispose previous.*/
239
	dev_kfree_skb(priv->beacon_skb);
Z
Zhu Yi 已提交
240

241
	priv->beacon_skb = beacon;
Z
Zhu Yi 已提交
242

243
	iwlagn_send_beacon_cmd(priv);
244 245
 out:
	mutex_unlock(&priv->mutex);
Z
Zhu Yi 已提交
246 247
}

248 249 250 251 252 253 254 255 256 257 258
static void iwl_bg_bt_runtime_config(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, bt_runtime_config);

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

	/* dont send host command if rf-kill is on */
	if (!iwl_is_ready_rf(priv))
		return;
W
Wey-Yi Guy 已提交
259
	iwlagn_send_advance_bt_config(priv);
260 261
}

262 263 264 265
static void iwl_bg_bt_full_concurrency(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, bt_full_concurrency);
266
	struct iwl_rxon_context *ctx;
267

268 269
	mutex_lock(&priv->mutex);

270
	if (test_bit(STATUS_EXIT_PENDING, &priv->status))
271
		goto out;
272 273 274

	/* dont send host command if rf-kill is on */
	if (!iwl_is_ready_rf(priv))
275
		goto out;
276 277 278 279 280 281 282 283 284

	IWL_DEBUG_INFO(priv, "BT coex in %s mode\n",
		       priv->bt_full_concurrent ?
		       "full concurrency" : "3-wire");

	/*
	 * LQ & RXON updated cmds must be sent before BT Config cmd
	 * to avoid 3-wire collisions
	 */
285
	for_each_context(priv, ctx) {
W
Wey-Yi Guy 已提交
286
		iwlagn_set_rxon_chain(priv, ctx);
287
		iwlagn_commit_rxon(priv, ctx);
288
	}
289

W
Wey-Yi Guy 已提交
290
	iwlagn_send_advance_bt_config(priv);
291 292
out:
	mutex_unlock(&priv->mutex);
293 294
}

295
/**
296
 * iwl_bg_statistics_periodic - Timer callback to queue statistics
297 298 299 300 301 302 303 304
 *
 * 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.
 */
305
static void iwl_bg_statistics_periodic(unsigned long data)
306 307 308 309 310 311
{
	struct iwl_priv *priv = (struct iwl_priv *)data;

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

312 313 314 315
	/* dont send host command if rf-kill is on */
	if (!iwl_is_ready_rf(priv))
		return;

316
	iwl_send_statistics_request(priv, CMD_ASYNC, false);
317 318
}

319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341

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 */
342
	iwl_write32(priv, HBUS_TARG_MEM_RADDR, ptr);
343 344 345 346 347 348 349
	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++) {
350 351
		ev = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
		time = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
352 353 354 355
		if (mode == 0) {
			trace_iwlwifi_dev_ucode_cont_event(priv,
							0, time, ev);
		} else {
356
			data = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
357 358 359 360 361 362 363 364 365
			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 已提交
366
static void iwl_continuous_event_trace(struct iwl_priv *priv)
367 368 369 370 371 372 373
{
	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 */

J
Johannes Berg 已提交
374
	base = priv->device_pointers.error_event_table;
375
	if (iwlagn_hw_valid_rtc_data_addr(base)) {
376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 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
		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));
	}
}

441 442 443 444 445 446 447 448 449 450 451 452
static void iwl_bg_tx_flush(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, tx_flush);

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

	/* do nothing if rf-kill is on */
	if (!iwl_is_ready_rf(priv))
		return;

453 454
	IWL_DEBUG_INFO(priv, "device request: flush all tx frames\n");
	iwlagn_dev_txfifo_flush(priv, IWL_DROP_ALL);
455 456
}

457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570
/*****************************************************************************
 *
 * sysfs attributes
 *
 *****************************************************************************/

#ifdef CONFIG_IWLWIFI_DEBUG

/*
 * The following adds a new attribute to the sysfs representation
 * of this device driver (i.e. a new file in /sys/class/net/wlan0/device/)
 * used for controlling the debug level.
 *
 * See the level definitions in iwl for details.
 *
 * 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.
 */
static ssize_t show_debug_level(struct device *d,
				struct device_attribute *attr, char *buf)
{
	struct iwl_priv *priv = dev_get_drvdata(d);
	return sprintf(buf, "0x%08X\n", iwl_get_debug_level(priv));
}
static ssize_t store_debug_level(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, 0, &val);
	if (ret)
		IWL_ERR(priv, "%s is not in hex or decimal form.\n", buf);
	else {
		priv->debug_level = val;
		if (iwl_alloc_traffic_mem(priv))
			IWL_ERR(priv,
				"Not enough memory to generate traffic log\n");
	}
	return strnlen(buf, count);
}

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


#endif /* CONFIG_IWLWIFI_DEBUG */


static ssize_t show_temperature(struct device *d,
				struct device_attribute *attr, char *buf)
{
	struct iwl_priv *priv = dev_get_drvdata(d);

	if (!iwl_is_alive(priv))
		return -EAGAIN;

	return sprintf(buf, "%d\n", priv->temperature);
}

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

static ssize_t show_tx_power(struct device *d,
			     struct device_attribute *attr, char *buf)
{
	struct iwl_priv *priv = dev_get_drvdata(d);

	if (!iwl_is_ready_rf(priv))
		return sprintf(buf, "off\n");
	else
		return sprintf(buf, "%d\n", priv->tx_power_user_lmt);
}

static ssize_t store_tx_power(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, "%s is not in decimal form.\n", buf);
	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;
}

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

static struct attribute *iwl_sysfs_entries[] = {
	&dev_attr_temperature.attr,
	&dev_attr_tx_power.attr,
#ifdef CONFIG_IWLWIFI_DEBUG
	&dev_attr_debug_level.attr,
#endif
	NULL
};

static struct attribute_group iwl_attribute_group = {
	.name = NULL,		/* put in device directory */
	.attrs = iwl_sysfs_entries,
};

Z
Zhu Yi 已提交
571 572 573 574 575 576
/******************************************************************************
 *
 * uCode download functions
 *
 ******************************************************************************/

577
static void iwl_free_fw_desc(struct iwl_priv *priv, struct fw_desc *desc)
578 579
{
	if (desc->v_addr)
580
		dma_free_coherent(priv->bus->dev, desc->len,
581 582 583 584 585
				  desc->v_addr, desc->p_addr);
	desc->v_addr = NULL;
	desc->len = 0;
}

586
static void iwl_free_fw_img(struct iwl_priv *priv, struct fw_img *img)
587
{
588 589
	iwl_free_fw_desc(priv, &img->code);
	iwl_free_fw_desc(priv, &img->data);
590 591
}

592 593 594 595 596 597 598
static void iwl_dealloc_ucode(struct iwl_priv *priv)
{
	iwl_free_fw_img(priv, &priv->ucode_rt);
	iwl_free_fw_img(priv, &priv->ucode_init);
}

static int iwl_alloc_fw_desc(struct iwl_priv *priv, struct fw_desc *desc,
599 600 601 602 603 604 605
			     const void *data, size_t len)
{
	if (!len) {
		desc->v_addr = NULL;
		return -EINVAL;
	}

606
	desc->v_addr = dma_alloc_coherent(priv->bus->dev, len,
607 608 609
					  &desc->p_addr, GFP_KERNEL);
	if (!desc->v_addr)
		return -ENOMEM;
610

611 612 613 614 615
	desc->len = len;
	memcpy(desc->v_addr, data, len);
	return 0;
}

616 617
struct iwlagn_ucode_capabilities {
	u32 max_probe_length;
618
	u32 standard_phy_calibration_size;
J
Johannes Berg 已提交
619
	u32 flags;
620
};
621

622
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context);
623 624
static int iwl_mac_setup_register(struct iwl_priv *priv,
				  struct iwlagn_ucode_capabilities *capa);
625

626 627 628
#define UCODE_EXPERIMENTAL_INDEX	100
#define UCODE_EXPERIMENTAL_TAG		"exp"

629 630 631
static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
{
	const char *name_pre = priv->cfg->fw_name_pre;
632
	char tag[8];
633

634 635 636 637 638 639
	if (first) {
#ifdef CONFIG_IWLWIFI_DEBUG_EXPERIMENTAL_UCODE
		priv->fw_index = UCODE_EXPERIMENTAL_INDEX;
		strcpy(tag, UCODE_EXPERIMENTAL_TAG);
	} else if (priv->fw_index == UCODE_EXPERIMENTAL_INDEX) {
#endif
640
		priv->fw_index = priv->cfg->ucode_api_max;
641 642
		sprintf(tag, "%d", priv->fw_index);
	} else {
643
		priv->fw_index--;
644 645
		sprintf(tag, "%d", priv->fw_index);
	}
646 647 648 649 650 651

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

652
	sprintf(priv->firmware_name, "%s%s%s", name_pre, tag, ".ucode");
653

654 655 656
	IWL_DEBUG_INFO(priv, "attempting to load firmware %s'%s'\n",
		       (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
				? "EXPERIMENTAL " : "",
657 658 659
		       priv->firmware_name);

	return request_firmware_nowait(THIS_MODULE, 1, priv->firmware_name,
660
				       priv->bus->dev,
661
				       GFP_KERNEL, priv, iwl_ucode_callback);
662 663
}

664
struct iwlagn_firmware_pieces {
J
Johannes Berg 已提交
665 666
	const void *inst, *data, *init, *init_data;
	size_t inst_size, data_size, init_size, init_data_size;
667 668

	u32 build;
669 670 671

	u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
	u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
};

static int iwlagn_load_legacy_firmware(struct iwl_priv *priv,
				       const struct firmware *ucode_raw,
				       struct iwlagn_firmware_pieces *pieces)
{
	struct iwl_ucode_header *ucode = (void *)ucode_raw->data;
	u32 api_ver, hdr_size;
	const u8 *src;

	priv->ucode_ver = le32_to_cpu(ucode->ver);
	api_ver = IWL_UCODE_API(priv->ucode_ver);

	switch (api_ver) {
	default:
687 688 689 690
		hdr_size = 28;
		if (ucode_raw->size < hdr_size) {
			IWL_ERR(priv, "File size too small!\n");
			return -EINVAL;
691
		}
692 693 694 695 696 697 698
		pieces->build = le32_to_cpu(ucode->u.v2.build);
		pieces->inst_size = le32_to_cpu(ucode->u.v2.inst_size);
		pieces->data_size = le32_to_cpu(ucode->u.v2.data_size);
		pieces->init_size = le32_to_cpu(ucode->u.v2.init_size);
		pieces->init_data_size = le32_to_cpu(ucode->u.v2.init_data_size);
		src = ucode->u.v2.data;
		break;
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718
	case 0:
	case 1:
	case 2:
		hdr_size = 24;
		if (ucode_raw->size < hdr_size) {
			IWL_ERR(priv, "File size too small!\n");
			return -EINVAL;
		}
		pieces->build = 0;
		pieces->inst_size = le32_to_cpu(ucode->u.v1.inst_size);
		pieces->data_size = le32_to_cpu(ucode->u.v1.data_size);
		pieces->init_size = le32_to_cpu(ucode->u.v1.init_size);
		pieces->init_data_size = le32_to_cpu(ucode->u.v1.init_data_size);
		src = ucode->u.v1.data;
		break;
	}

	/* Verify size of file vs. image size info in file's header */
	if (ucode_raw->size != hdr_size + pieces->inst_size +
				pieces->data_size + pieces->init_size +
J
Johannes Berg 已提交
719
				pieces->init_data_size) {
720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738

		IWL_ERR(priv,
			"uCode file size %d does not match expected size\n",
			(int)ucode_raw->size);
		return -EINVAL;
	}

	pieces->inst = src;
	src += pieces->inst_size;
	pieces->data = src;
	src += pieces->data_size;
	pieces->init = src;
	src += pieces->init_size;
	pieces->init_data = src;
	src += pieces->init_data_size;

	return 0;
}

739 740 741 742 743 744 745 746 747 748 749 750 751
static int iwlagn_wanted_ucode_alternative = 1;

static int iwlagn_load_firmware(struct iwl_priv *priv,
				const struct firmware *ucode_raw,
				struct iwlagn_firmware_pieces *pieces,
				struct iwlagn_ucode_capabilities *capa)
{
	struct iwl_tlv_ucode_header *ucode = (void *)ucode_raw->data;
	struct iwl_ucode_tlv *tlv;
	size_t len = ucode_raw->size;
	const u8 *data;
	int wanted_alternative = iwlagn_wanted_ucode_alternative, tmp;
	u64 alternatives;
752 753 754
	u32 tlv_len;
	enum iwl_ucode_tlv_type tlv_type;
	const u8 *tlv_data;
755

756 757
	if (len < sizeof(*ucode)) {
		IWL_ERR(priv, "uCode has invalid length: %zd\n", len);
758
		return -EINVAL;
759
	}
760

761 762 763
	if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
		IWL_ERR(priv, "invalid uCode magic: 0X%x\n",
			le32_to_cpu(ucode->magic));
764
		return -EINVAL;
765
	}
766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789

	/*
	 * Check which alternatives are present, and "downgrade"
	 * when the chosen alternative is not present, warning
	 * the user when that happens. Some files may not have
	 * any alternatives, so don't warn in that case.
	 */
	alternatives = le64_to_cpu(ucode->alternatives);
	tmp = wanted_alternative;
	if (wanted_alternative > 63)
		wanted_alternative = 63;
	while (wanted_alternative && !(alternatives & BIT(wanted_alternative)))
		wanted_alternative--;
	if (wanted_alternative && wanted_alternative != tmp)
		IWL_WARN(priv,
			 "uCode alternative %d not available, choosing %d\n",
			 tmp, wanted_alternative);

	priv->ucode_ver = le32_to_cpu(ucode->ver);
	pieces->build = le32_to_cpu(ucode->build);
	data = ucode->data;

	len -= sizeof(*ucode);

790
	while (len >= sizeof(*tlv)) {
791 792 793 794 795 796 797 798 799 800
		u16 tlv_alt;

		len -= sizeof(*tlv);
		tlv = (void *)data;

		tlv_len = le32_to_cpu(tlv->length);
		tlv_type = le16_to_cpu(tlv->type);
		tlv_alt = le16_to_cpu(tlv->alternative);
		tlv_data = tlv->data;

801 802 803
		if (len < tlv_len) {
			IWL_ERR(priv, "invalid TLV len: %zd/%u\n",
				len, tlv_len);
804
			return -EINVAL;
805
		}
806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834
		len -= ALIGN(tlv_len, 4);
		data += sizeof(*tlv) + ALIGN(tlv_len, 4);

		/*
		 * Alternative 0 is always valid.
		 *
		 * Skip alternative TLVs that are not selected.
		 */
		if (tlv_alt != 0 && tlv_alt != wanted_alternative)
			continue;

		switch (tlv_type) {
		case IWL_UCODE_TLV_INST:
			pieces->inst = tlv_data;
			pieces->inst_size = tlv_len;
			break;
		case IWL_UCODE_TLV_DATA:
			pieces->data = tlv_data;
			pieces->data_size = tlv_len;
			break;
		case IWL_UCODE_TLV_INIT:
			pieces->init = tlv_data;
			pieces->init_size = tlv_len;
			break;
		case IWL_UCODE_TLV_INIT_DATA:
			pieces->init_data = tlv_data;
			pieces->init_data_size = tlv_len;
			break;
		case IWL_UCODE_TLV_BOOT:
J
Johannes Berg 已提交
835
			IWL_ERR(priv, "Found unexpected BOOT ucode\n");
836 837
			break;
		case IWL_UCODE_TLV_PROBE_MAX_LEN:
838 839 840
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			capa->max_probe_length =
841
					le32_to_cpup((__le32 *)tlv_data);
842
			break;
J
Johannes Berg 已提交
843 844 845
		case IWL_UCODE_TLV_PAN:
			if (tlv_len)
				goto invalid_tlv_len;
J
Johannes Berg 已提交
846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862
			capa->flags |= IWL_UCODE_TLV_FLAGS_PAN;
			break;
		case IWL_UCODE_TLV_FLAGS:
			/* must be at least one u32 */
			if (tlv_len < sizeof(u32))
				goto invalid_tlv_len;
			/* and a proper number of u32s */
			if (tlv_len % sizeof(u32))
				goto invalid_tlv_len;
			/*
			 * This driver only reads the first u32 as
			 * right now no more features are defined,
			 * if that changes then either the driver
			 * will not work with the new firmware, or
			 * it'll not take advantage of new features.
			 */
			capa->flags = le32_to_cpup((__le32 *)tlv_data);
J
Johannes Berg 已提交
863
			break;
864
		case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
865 866 867
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_evtlog_ptr =
868
					le32_to_cpup((__le32 *)tlv_data);
869 870
			break;
		case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
871 872 873
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_evtlog_size =
874
					le32_to_cpup((__le32 *)tlv_data);
875 876
			break;
		case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
877 878 879
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_errlog_ptr =
880
					le32_to_cpup((__le32 *)tlv_data);
881 882
			break;
		case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
883 884 885
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_evtlog_ptr =
886
					le32_to_cpup((__le32 *)tlv_data);
887 888
			break;
		case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
889 890 891
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_evtlog_size =
892
					le32_to_cpup((__le32 *)tlv_data);
893 894
			break;
		case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
895 896 897
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_errlog_ptr =
898
					le32_to_cpup((__le32 *)tlv_data);
899
			break;
900 901
		case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
			if (tlv_len)
902 903
				goto invalid_tlv_len;
			priv->enhance_sensitivity_table = true;
904
			break;
905
		case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
906 907 908
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			capa->standard_phy_calibration_size =
909 910
					le32_to_cpup((__le32 *)tlv_data);
			break;
911
		default:
912
			IWL_DEBUG_INFO(priv, "unknown TLV: %d\n", tlv_type);
913 914 915 916
			break;
		}
	}

917 918 919
	if (len) {
		IWL_ERR(priv, "invalid TLV after parsing: %zd\n", len);
		iwl_print_hex_dump(priv, IWL_DL_FW, (u8 *)data, len);
920
		return -EINVAL;
921
	}
922

923 924 925 926 927 928 929
	return 0;

 invalid_tlv_len:
	IWL_ERR(priv, "TLV %d has invalid size: %u\n", tlv_type, tlv_len);
	iwl_print_hex_dump(priv, IWL_DL_FW, tlv_data, tlv_len);

	return -EINVAL;
930 931
}

Z
Zhu Yi 已提交
932
/**
933
 * iwl_ucode_callback - callback when firmware was loaded
Z
Zhu Yi 已提交
934
 *
935 936
 * If loaded successfully, copies the firmware into buffers
 * for the card to fetch (via DMA).
Z
Zhu Yi 已提交
937
 */
938
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context)
Z
Zhu Yi 已提交
939
{
940
	struct iwl_priv *priv = context;
941
	struct iwl_ucode_header *ucode;
942 943
	int err;
	struct iwlagn_firmware_pieces pieces;
944 945
	const unsigned int api_max = priv->cfg->ucode_api_max;
	const unsigned int api_min = priv->cfg->ucode_api_min;
946
	u32 api_ver;
947
	char buildstr[25];
948
	u32 build;
949 950
	struct iwlagn_ucode_capabilities ucode_capa = {
		.max_probe_length = 200,
951
		.standard_phy_calibration_size =
952
			IWL_DEFAULT_STANDARD_PHY_CALIBRATE_TBL_SIZE,
953
	};
954 955

	memset(&pieces, 0, sizeof(pieces));
Z
Zhu Yi 已提交
956

957
	if (!ucode_raw) {
958 959 960 961
		if (priv->fw_index <= priv->cfg->ucode_api_max)
			IWL_ERR(priv,
				"request for firmware file '%s' failed.\n",
				priv->firmware_name);
962
		goto try_again;
Z
Zhu Yi 已提交
963 964
	}

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

968 969
	/* Make sure that we got at least the API version number */
	if (ucode_raw->size < 4) {
970
		IWL_ERR(priv, "File size way too small!\n");
971
		goto try_again;
Z
Zhu Yi 已提交
972 973 974
	}

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

977 978 979
	if (ucode->ver)
		err = iwlagn_load_legacy_firmware(priv, ucode_raw, &pieces);
	else
980 981
		err = iwlagn_load_firmware(priv, ucode_raw, &pieces,
					   &ucode_capa);
982

983 984
	if (err)
		goto try_again;
Z
Zhu Yi 已提交
985

986
	api_ver = IWL_UCODE_API(priv->ucode_ver);
987
	build = pieces.build;
988

989 990 991 992 993
	/*
	 * api_ver should match the api version forming part of the
	 * firmware filename ... but we don't check for that and only rely
	 * on the API version read from firmware header from here on forward
	 */
994 995 996 997 998 999 1000 1001 1002
	/* no api version check required for experimental uCode */
	if (priv->fw_index != UCODE_EXPERIMENTAL_INDEX) {
		if (api_ver < api_min || api_ver > api_max) {
			IWL_ERR(priv,
				"Driver unable to support your firmware API. "
				"Driver supports v%u, firmware is v%u.\n",
				api_max, api_ver);
			goto try_again;
		}
1003

1004 1005 1006 1007 1008 1009 1010
		if (api_ver != api_max)
			IWL_ERR(priv,
				"Firmware has old API version. Expected v%u, "
				"got v%u. New firmware can be obtained "
				"from http://www.intellinuxwireless.org.\n",
				api_max, api_ver);
	}
1011

1012
	if (build)
1013 1014 1015
		sprintf(buildstr, " build %u%s", build,
		       (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
				? " (EXP)" : "");
1016 1017 1018 1019 1020 1021 1022 1023 1024
	else
		buildstr[0] = '\0';

	IWL_INFO(priv, "loaded firmware version %u.%u.%u.%u%s\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),
		 buildstr);
1025

1026 1027
	snprintf(priv->hw->wiphy->fw_version,
		 sizeof(priv->hw->wiphy->fw_version),
1028
		 "%u.%u.%u.%u%s",
1029 1030 1031
		 IWL_UCODE_MAJOR(priv->ucode_ver),
		 IWL_UCODE_MINOR(priv->ucode_ver),
		 IWL_UCODE_API(priv->ucode_ver),
1032 1033
		 IWL_UCODE_SERIAL(priv->ucode_ver),
		 buildstr);
Z
Zhu Yi 已提交
1034

1035 1036 1037 1038 1039 1040
	/*
	 * 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.
	 */

1041 1042 1043 1044 1045 1046 1047 1048 1049 1050
	IWL_DEBUG_INFO(priv, "f/w package hdr ucode version raw = 0x%x\n",
		       priv->ucode_ver);
	IWL_DEBUG_INFO(priv, "f/w package hdr runtime inst size = %Zd\n",
		       pieces.inst_size);
	IWL_DEBUG_INFO(priv, "f/w package hdr runtime data size = %Zd\n",
		       pieces.data_size);
	IWL_DEBUG_INFO(priv, "f/w package hdr init inst size = %Zd\n",
		       pieces.init_size);
	IWL_DEBUG_INFO(priv, "f/w package hdr init data size = %Zd\n",
		       pieces.init_data_size);
Z
Zhu Yi 已提交
1051 1052

	/* Verify that uCode images will fit in card's SRAM */
1053 1054 1055
	if (pieces.inst_size > priv->hw_params.max_inst_size) {
		IWL_ERR(priv, "uCode instr len %Zd too large to fit in\n",
			pieces.inst_size);
1056
		goto try_again;
Z
Zhu Yi 已提交
1057 1058
	}

1059 1060 1061
	if (pieces.data_size > priv->hw_params.max_data_size) {
		IWL_ERR(priv, "uCode data len %Zd too large to fit in\n",
			pieces.data_size);
1062
		goto try_again;
Z
Zhu Yi 已提交
1063
	}
1064 1065 1066 1067

	if (pieces.init_size > priv->hw_params.max_inst_size) {
		IWL_ERR(priv, "uCode init instr len %Zd too large to fit in\n",
			pieces.init_size);
1068
		goto try_again;
Z
Zhu Yi 已提交
1069
	}
1070 1071 1072 1073

	if (pieces.init_data_size > priv->hw_params.max_data_size) {
		IWL_ERR(priv, "uCode init data len %Zd too large to fit in\n",
			pieces.init_data_size);
1074
		goto try_again;
Z
Zhu Yi 已提交
1075
	}
1076

Z
Zhu Yi 已提交
1077 1078 1079 1080 1081
	/* 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 */
1082
	if (iwl_alloc_fw_desc(priv, &priv->ucode_rt.code,
1083 1084
			      pieces.inst, pieces.inst_size))
		goto err_pci_alloc;
1085
	if (iwl_alloc_fw_desc(priv, &priv->ucode_rt.data,
1086
			      pieces.data, pieces.data_size))
1087 1088
		goto err_pci_alloc;

Z
Zhu Yi 已提交
1089
	/* Initialization instructions and data */
1090
	if (pieces.init_size && pieces.init_data_size) {
1091
		if (iwl_alloc_fw_desc(priv, &priv->ucode_init.code,
1092 1093
				      pieces.init, pieces.init_size))
			goto err_pci_alloc;
1094
		if (iwl_alloc_fw_desc(priv, &priv->ucode_init.data,
1095
				      pieces.init_data, pieces.init_data_size))
1096 1097
			goto err_pci_alloc;
	}
Z
Zhu Yi 已提交
1098

1099 1100 1101 1102 1103 1104 1105
	/* Now that we can no longer fail, copy information */

	/*
	 * The (size - 16) / 12 formula is based on the information recorded
	 * for each event, which is of mode 1 (including timestamp) for all
	 * new microcodes that include this information.
	 */
W
Wey-Yi Guy 已提交
1106
	priv->init_evtlog_ptr = pieces.init_evtlog_ptr;
1107
	if (pieces.init_evtlog_size)
W
Wey-Yi Guy 已提交
1108
		priv->init_evtlog_size = (pieces.init_evtlog_size - 16)/12;
1109
	else
W
Wey-Yi Guy 已提交
1110
		priv->init_evtlog_size =
1111
			priv->cfg->base_params->max_event_log_size;
W
Wey-Yi Guy 已提交
1112 1113
	priv->init_errlog_ptr = pieces.init_errlog_ptr;
	priv->inst_evtlog_ptr = pieces.inst_evtlog_ptr;
1114
	if (pieces.inst_evtlog_size)
W
Wey-Yi Guy 已提交
1115
		priv->inst_evtlog_size = (pieces.inst_evtlog_size - 16)/12;
1116
	else
W
Wey-Yi Guy 已提交
1117
		priv->inst_evtlog_size =
1118
			priv->cfg->base_params->max_event_log_size;
W
Wey-Yi Guy 已提交
1119
	priv->inst_errlog_ptr = pieces.inst_errlog_ptr;
1120

1121 1122 1123
	priv->new_scan_threshold_behaviour =
		!!(ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWSCAN);

1124 1125
	if ((priv->cfg->sku & EEPROM_SKU_CAP_IPAN_ENABLE) &&
	    (ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN)) {
J
Johannes Berg 已提交
1126
		priv->valid_contexts |= BIT(IWL_RXON_CTX_PAN);
1127
		priv->sta_key_max_num = STA_KEY_MAX_NUM_PAN;
J
Johannes Berg 已提交
1128 1129
	} else
		priv->sta_key_max_num = STA_KEY_MAX_NUM;
1130

J
Johannes Berg 已提交
1131 1132 1133 1134 1135
	if (priv->valid_contexts != BIT(IWL_RXON_CTX_BSS))
		priv->cmd_queue = IWL_IPAN_CMD_QUEUE_NUM;
	else
		priv->cmd_queue = IWL_DEFAULT_CMD_QUEUE_NUM;

1136 1137 1138 1139 1140 1141 1142 1143 1144
	/*
	 * figure out the offset of chain noise reset and gain commands
	 * base on the size of standard phy calibration commands table size
	 */
	if (ucode_capa.standard_phy_calibration_size >
	    IWL_MAX_PHY_CALIBRATE_TBL_SIZE)
		ucode_capa.standard_phy_calibration_size =
			IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE;

W
Wey-Yi Guy 已提交
1145
	priv->phy_calib_chain_noise_reset_cmd =
1146
		ucode_capa.standard_phy_calibration_size;
W
Wey-Yi Guy 已提交
1147
	priv->phy_calib_chain_noise_gain_cmd =
1148 1149
		ucode_capa.standard_phy_calibration_size + 1;

1150 1151 1152 1153 1154
	/**************************************************
	 * This is still part of probe() in a sense...
	 *
	 * 9. Setup and register with mac80211 and debugfs
	 **************************************************/
1155
	err = iwl_mac_setup_register(priv, &ucode_capa);
1156 1157 1158 1159 1160 1161 1162
	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);

1163
	err = sysfs_create_group(&(priv->bus->dev->kobj),
1164 1165 1166 1167 1168 1169
					&iwl_attribute_group);
	if (err) {
		IWL_ERR(priv, "failed to create sysfs device attributes\n");
		goto out_unbind;
	}

Z
Zhu Yi 已提交
1170 1171
	/* We have our copies now, allow OS release its copies */
	release_firmware(ucode_raw);
W
Wey-Yi Guy 已提交
1172
	complete(&priv->firmware_loading_complete);
1173 1174 1175 1176 1177 1178 1179 1180
	return;

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

 err_pci_alloc:
1183
	IWL_ERR(priv, "failed to allocate pci memory\n");
1184
	iwl_dealloc_ucode(priv);
1185
 out_unbind:
W
Wey-Yi Guy 已提交
1186
	complete(&priv->firmware_loading_complete);
1187
	device_release_driver(priv->bus->dev);
Z
Zhu Yi 已提交
1188 1189 1190
	release_firmware(ucode_raw);
}

1191
static const char * const desc_lookup_text[] = {
1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214
	"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",
1215
	"NMI_INTERRUPT_BREAK_POINT",
1216 1217 1218 1219 1220 1221
	"DEBUG_0",
	"DEBUG_1",
	"DEBUG_2",
	"DEBUG_3",
};

1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241
static struct { char *name; u8 num; } advanced_lookup[] = {
	{ "NMI_INTERRUPT_WDG", 0x34 },
	{ "SYSASSERT", 0x35 },
	{ "UCODE_VERSION_MISMATCH", 0x37 },
	{ "BAD_COMMAND", 0x38 },
	{ "NMI_INTERRUPT_DATA_ACTION_PT", 0x3C },
	{ "FATAL_ERROR", 0x3D },
	{ "NMI_TRM_HW_ERR", 0x46 },
	{ "NMI_INTERRUPT_TRM", 0x4C },
	{ "NMI_INTERRUPT_BREAK_POINT", 0x54 },
	{ "NMI_INTERRUPT_WDG_RXF_FULL", 0x5C },
	{ "NMI_INTERRUPT_WDG_NO_RBD_RXF_FULL", 0x64 },
	{ "NMI_INTERRUPT_HOST", 0x66 },
	{ "NMI_INTERRUPT_ACTION_PT", 0x7C },
	{ "NMI_INTERRUPT_UNKNOWN", 0x84 },
	{ "NMI_INTERRUPT_INST_ACTION_PT", 0x86 },
	{ "ADVANCED_SYSASSERT", 0 },
};

static const char *desc_lookup(u32 num)
1242
{
1243 1244
	int i;
	int max = ARRAY_SIZE(desc_lookup_text);
1245

1246 1247
	if (num < max)
		return desc_lookup_text[num];
1248

1249 1250 1251
	max = ARRAY_SIZE(advanced_lookup) - 1;
	for (i = 0; i < max; i++) {
		if (advanced_lookup[i].num == num)
1252
			break;
1253 1254
	}
	return advanced_lookup[i].name;
1255 1256 1257 1258 1259 1260 1261
}

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

void iwl_dump_nic_error_log(struct iwl_priv *priv)
{
W
Wey-Yi Guy 已提交
1262
	u32 base;
1263
	struct iwl_error_event_table table;
1264

J
Johannes Berg 已提交
1265
	base = priv->device_pointers.error_event_table;
1266
	if (priv->ucode_type == IWL_UCODE_INIT) {
1267
		if (!base)
W
Wey-Yi Guy 已提交
1268
			base = priv->init_errlog_ptr;
1269 1270
	} else {
		if (!base)
W
Wey-Yi Guy 已提交
1271
			base = priv->inst_errlog_ptr;
1272
	}
1273

1274
	if (!iwlagn_hw_valid_rtc_data_addr(base)) {
1275 1276
		IWL_ERR(priv,
			"Not valid error log pointer 0x%08X for %s uCode\n",
1277
			base,
1278
			(priv->ucode_type == IWL_UCODE_INIT)
1279
					? "Init" : "RT");
1280 1281 1282
		return;
	}

1283 1284
	iwl_read_targ_mem_words(priv, base, &table, sizeof(table));

W
Wey-Yi Guy 已提交
1285
	if (ERROR_START_OFFSET <= table.valid * ERROR_ELEM_SIZE) {
1286 1287
		IWL_ERR(priv, "Start IWL Error Log Dump:\n");
		IWL_ERR(priv, "Status: 0x%08lX, count: %d\n",
W
Wey-Yi Guy 已提交
1288
			priv->status, table.valid);
1289 1290
	}

W
Wey-Yi Guy 已提交
1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
	priv->isr_stats.err_code = table.error_id;

	trace_iwlwifi_dev_ucode_error(priv, table.error_id, table.tsf_low,
				      table.data1, table.data2, table.line,
				      table.blink1, table.blink2, table.ilink1,
				      table.ilink2, table.bcon_time, table.gp1,
				      table.gp2, table.gp3, table.ucode_ver,
				      table.hw_ver, table.brd_ver);
	IWL_ERR(priv, "0x%08X | %-28s\n", table.error_id,
		desc_lookup(table.error_id));
	IWL_ERR(priv, "0x%08X | uPc\n", table.pc);
	IWL_ERR(priv, "0x%08X | branchlink1\n", table.blink1);
	IWL_ERR(priv, "0x%08X | branchlink2\n", table.blink2);
	IWL_ERR(priv, "0x%08X | interruptlink1\n", table.ilink1);
	IWL_ERR(priv, "0x%08X | interruptlink2\n", table.ilink2);
	IWL_ERR(priv, "0x%08X | data1\n", table.data1);
	IWL_ERR(priv, "0x%08X | data2\n", table.data2);
	IWL_ERR(priv, "0x%08X | line\n", table.line);
	IWL_ERR(priv, "0x%08X | beacon time\n", table.bcon_time);
	IWL_ERR(priv, "0x%08X | tsf low\n", table.tsf_low);
	IWL_ERR(priv, "0x%08X | tsf hi\n", table.tsf_hi);
	IWL_ERR(priv, "0x%08X | time gp1\n", table.gp1);
	IWL_ERR(priv, "0x%08X | time gp2\n", table.gp2);
	IWL_ERR(priv, "0x%08X | time gp3\n", table.gp3);
	IWL_ERR(priv, "0x%08X | uCode version\n", table.ucode_ver);
	IWL_ERR(priv, "0x%08X | hw version\n", table.hw_ver);
	IWL_ERR(priv, "0x%08X | board version\n", table.brd_ver);
	IWL_ERR(priv, "0x%08X | hcmd\n", table.hcmd);
1319 1320 1321 1322 1323 1324 1325 1326
}

#define EVENT_START_OFFSET  (4 * sizeof(u32))

/**
 * iwl_print_event_log - Dump error event log to syslog
 *
 */
W
Wey-Yi Guy 已提交
1327 1328 1329
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)
1330 1331 1332 1333 1334 1335
{
	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 已提交
1336
	unsigned long reg_flags;
1337 1338

	if (num_events == 0)
W
Wey-Yi Guy 已提交
1339
		return pos;
1340

J
Johannes Berg 已提交
1341
	base = priv->device_pointers.log_event_table;
1342
	if (priv->ucode_type == IWL_UCODE_INIT) {
1343
		if (!base)
W
Wey-Yi Guy 已提交
1344
			base = priv->init_evtlog_ptr;
1345 1346
	} else {
		if (!base)
W
Wey-Yi Guy 已提交
1347
			base = priv->inst_evtlog_ptr;
1348
	}
1349 1350 1351 1352 1353 1354 1355 1356

	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 已提交
1357 1358 1359 1360 1361
	/* 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 */
1362
	iwl_write32(priv, HBUS_TARG_MEM_RADDR, ptr);
B
Ben Cahill 已提交
1363 1364
	rmb();

1365 1366 1367
	/* "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++) {
1368 1369
		ev = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
		time = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
1370 1371
		if (mode == 0) {
			/* data, ev */
W
Wey-Yi Guy 已提交
1372 1373 1374 1375 1376 1377 1378 1379 1380 1381
			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);
			}
1382
		} else {
1383
			data = iwl_read32(priv, HBUS_TARG_MEM_RDAT);
W
Wey-Yi Guy 已提交
1384 1385 1386 1387 1388 1389
			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",
1390
					time, data, ev);
W
Wey-Yi Guy 已提交
1391 1392 1393
				trace_iwlwifi_dev_ucode_event(priv, time,
					data, ev);
			}
1394 1395
		}
	}
B
Ben Cahill 已提交
1396 1397 1398 1399

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

1403 1404 1405
/**
 * iwl_print_last_event_logs - Dump the newest # of event log to syslog
 */
W
Wey-Yi Guy 已提交
1406 1407 1408 1409
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)
1410 1411 1412 1413 1414 1415 1416
{
	/*
	 * 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 已提交
1417 1418 1419 1420 1421 1422 1423
			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);
1424
		} else
W
Wey-Yi Guy 已提交
1425 1426
			pos = iwl_print_event_log(priv, next_entry - size,
						  size, mode, pos, buf, bufsz);
1427
	} else {
W
Wey-Yi Guy 已提交
1428 1429 1430 1431 1432 1433 1434
		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);
		}
1435
	}
W
Wey-Yi Guy 已提交
1436
	return pos;
1437 1438 1439 1440
}

#define DEFAULT_DUMP_EVENT_LOG_ENTRIES (20)

W
Wey-Yi Guy 已提交
1441 1442
int iwl_dump_nic_event_log(struct iwl_priv *priv, bool full_log,
			    char **buf, bool display)
1443 1444 1445 1446 1447 1448 1449
{
	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 */
1450
	u32 logsize;
W
Wey-Yi Guy 已提交
1451 1452
	int pos = 0;
	size_t bufsz = 0;
1453

J
Johannes Berg 已提交
1454
	base = priv->device_pointers.log_event_table;
1455
	if (priv->ucode_type == IWL_UCODE_INIT) {
W
Wey-Yi Guy 已提交
1456
		logsize = priv->init_evtlog_size;
1457
		if (!base)
W
Wey-Yi Guy 已提交
1458
			base = priv->init_evtlog_ptr;
1459
	} else {
W
Wey-Yi Guy 已提交
1460
		logsize = priv->inst_evtlog_size;
1461
		if (!base)
W
Wey-Yi Guy 已提交
1462
			base = priv->inst_evtlog_ptr;
1463
	}
1464

1465
	if (!iwlagn_hw_valid_rtc_data_addr(base)) {
1466 1467
		IWL_ERR(priv,
			"Invalid event log pointer 0x%08X for %s uCode\n",
1468
			base,
1469
			(priv->ucode_type == IWL_UCODE_INIT)
1470
					? "Init" : "RT");
1471
		return -EINVAL;
1472 1473 1474 1475 1476 1477 1478 1479
	}

	/* 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)));

1480
	if (capacity > logsize) {
B
Ben Cahill 已提交
1481
		IWL_ERR(priv, "Log capacity %d is bogus, limit to %d entries\n",
1482 1483
			capacity, logsize);
		capacity = logsize;
B
Ben Cahill 已提交
1484 1485
	}

1486
	if (next_entry > logsize) {
B
Ben Cahill 已提交
1487
		IWL_ERR(priv, "Log write index %d is bogus, limit to %d\n",
1488 1489
			next_entry, logsize);
		next_entry = logsize;
B
Ben Cahill 已提交
1490 1491
	}

1492 1493 1494 1495 1496
	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 已提交
1497
		return pos;
1498 1499
	}

1500
	/* enable/disable bt channel inhibition */
1501 1502
	priv->bt_ch_announce = iwlagn_bt_ch_announce;

1503
#ifdef CONFIG_IWLWIFI_DEBUG
1504
	if (!(iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) && !full_log)
1505 1506 1507 1508 1509 1510 1511 1512
		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);
1513

1514
#ifdef CONFIG_IWLWIFI_DEBUG
W
Wey-Yi Guy 已提交
1515 1516 1517 1518 1519 1520 1521
	if (display) {
		if (full_log)
			bufsz = capacity * 48;
		else
			bufsz = size * 48;
		*buf = kmalloc(bufsz, GFP_KERNEL);
		if (!*buf)
1522
			return -ENOMEM;
W
Wey-Yi Guy 已提交
1523
	}
1524 1525 1526 1527 1528 1529 1530
	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 已提交
1531 1532 1533
			pos = iwl_print_event_log(priv, next_entry,
						capacity - next_entry, mode,
						pos, buf, bufsz);
1534
		/* (then/else) start at top of log */
W
Wey-Yi Guy 已提交
1535 1536
		pos = iwl_print_event_log(priv, 0,
					  next_entry, mode, pos, buf, bufsz);
1537
	} else
W
Wey-Yi Guy 已提交
1538 1539 1540
		pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
						next_entry, size, mode,
						pos, buf, bufsz);
1541
#else
W
Wey-Yi Guy 已提交
1542 1543 1544
	pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
					next_entry, size, mode,
					pos, buf, bufsz);
1545
#endif
W
Wey-Yi Guy 已提交
1546
	return pos;
1547
}
1548

1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
static void iwl_rf_kill_ct_config(struct iwl_priv *priv)
{
	struct iwl_ct_kill_config cmd;
	struct iwl_ct_kill_throttling_config adv_cmd;
	unsigned long flags;
	int ret = 0;

	spin_lock_irqsave(&priv->lock, flags);
	iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
		    CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT);
	spin_unlock_irqrestore(&priv->lock, flags);
	priv->thermal_throttle.ct_kill_toggle = false;

1562
	if (priv->cfg->base_params->support_ct_kill_exit) {
1563 1564 1565 1566 1567
		adv_cmd.critical_temperature_enter =
			cpu_to_le32(priv->hw_params.ct_kill_threshold);
		adv_cmd.critical_temperature_exit =
			cpu_to_le32(priv->hw_params.ct_kill_exit_threshold);

1568
		ret = trans_send_cmd_pdu(&priv->trans,
1569 1570
				       REPLY_CT_KILL_CONFIG_CMD,
				       CMD_SYNC, sizeof(adv_cmd), &adv_cmd);
1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
		if (ret)
			IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
		else
			IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
					"succeeded, "
					"critical temperature enter is %d,"
					"exit is %d\n",
				       priv->hw_params.ct_kill_threshold,
				       priv->hw_params.ct_kill_exit_threshold);
	} else {
		cmd.critical_temperature_R =
			cpu_to_le32(priv->hw_params.ct_kill_threshold);

1584
		ret = trans_send_cmd_pdu(&priv->trans,
1585 1586
				       REPLY_CT_KILL_CONFIG_CMD,
				       CMD_SYNC, sizeof(cmd), &cmd);
1587 1588 1589 1590 1591 1592 1593 1594 1595 1596
		if (ret)
			IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
		else
			IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
					"succeeded, "
					"critical temperature is %d\n",
					priv->hw_params.ct_kill_threshold);
	}
}

1597 1598 1599 1600 1601
static int iwlagn_send_calib_cfg_rt(struct iwl_priv *priv, u32 cfg)
{
	struct iwl_calib_cfg_cmd calib_cfg_cmd;
	struct iwl_host_cmd cmd = {
		.id = CALIBRATION_CFG_CMD,
1602 1603
		.len = { sizeof(struct iwl_calib_cfg_cmd), },
		.data = { &calib_cfg_cmd, },
1604 1605 1606 1607
	};

	memset(&calib_cfg_cmd, 0, sizeof(calib_cfg_cmd));
	calib_cfg_cmd.ucd_calib_cfg.once.is_enable = IWL_CALIB_INIT_CFG_ALL;
1608
	calib_cfg_cmd.ucd_calib_cfg.once.start = cpu_to_le32(cfg);
1609

1610
	return trans_send_cmd(&priv->trans, &cmd);
1611 1612 1613
}


W
Wey-Yi Guy 已提交
1614 1615 1616 1617 1618 1619 1620 1621
static int iwlagn_send_tx_ant_config(struct iwl_priv *priv, u8 valid_tx_ant)
{
	struct iwl_tx_ant_config_cmd tx_ant_cmd = {
	  .valid = cpu_to_le32(valid_tx_ant),
	};

	if (IWL_UCODE_API(priv->ucode_ver) > 1) {
		IWL_DEBUG_HC(priv, "select valid tx ant: %u\n", valid_tx_ant);
1622
		return trans_send_cmd_pdu(&priv->trans,
W
Wey-Yi Guy 已提交
1623 1624 1625 1626 1627 1628 1629 1630 1631 1632
					TX_ANT_CONFIGURATION_CMD,
					CMD_SYNC,
					sizeof(struct iwl_tx_ant_config_cmd),
					&tx_ant_cmd);
	} else {
		IWL_DEBUG_HC(priv, "TX_ANT_CONFIGURATION_CMD not supported\n");
		return -EOPNOTSUPP;
	}
}

Z
Zhu Yi 已提交
1633
/**
1634
 * iwl_alive_start - called after REPLY_ALIVE notification received
Z
Zhu Yi 已提交
1635
 *                   from protocol/runtime uCode (initialization uCode's
1636
 *                   Alive gets handled by iwl_init_alive_start()).
Z
Zhu Yi 已提交
1637
 */
1638
int iwl_alive_start(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1639
{
1640
	int ret = 0;
1641
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
Z
Zhu Yi 已提交
1642

1643
	/*TODO: this should go to the transport layer */
1644
	iwl_reset_ict(priv);
Z
Zhu Yi 已提交
1645

1646
	IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
1647

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

1651 1652
	/* Enable watchdog to monitor the driver tx queues */
	iwl_setup_watchdog(priv);
1653

1654
	if (iwl_is_rfkill(priv))
1655
		return -ERFKILL;
Z
Zhu Yi 已提交
1656

1657
	/* download priority table before any calibration request */
1658 1659
	if (priv->cfg->bt_params &&
	    priv->cfg->bt_params->advanced_bt_coexist) {
1660
		/* Configure Bluetooth device coexistence support */
1661 1662 1663 1664 1665
		if (priv->cfg->bt_params->bt_sco_disable)
			priv->bt_enable_pspoll = false;
		else
			priv->bt_enable_pspoll = true;

1666 1667 1668
		priv->bt_valid = IWLAGN_BT_ALL_VALID_MSK;
		priv->kill_ack_mask = IWLAGN_BT_KILL_ACK_MASK_DEFAULT;
		priv->kill_cts_mask = IWLAGN_BT_KILL_CTS_MASK_DEFAULT;
W
Wey-Yi Guy 已提交
1669
		iwlagn_send_advance_bt_config(priv);
1670
		priv->bt_valid = IWLAGN_BT_VALID_ENABLE_FLAGS;
1671 1672
		priv->cur_rssi_ctx = NULL;

1673
		iwlagn_send_prio_tbl(priv);
1674 1675

		/* FIXME: w/a to force change uCode BT state machine */
1676 1677 1678 1679 1680 1681 1682 1683
		ret = iwlagn_send_bt_env(priv, IWL_BT_COEX_ENV_OPEN,
					 BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
		if (ret)
			return ret;
		ret = iwlagn_send_bt_env(priv, IWL_BT_COEX_ENV_CLOSE,
					 BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
		if (ret)
			return ret;
W
Wey-Yi Guy 已提交
1684 1685 1686 1687 1688
	} else {
		/*
		 * default is 2-wire BT coexexistence support
		 */
		iwl_send_bt_config(priv);
1689
	}
W
Wey-Yi Guy 已提交
1690

1691 1692 1693
	if (priv->hw_params.calib_rt_cfg)
		iwlagn_send_calib_cfg_rt(priv, priv->hw_params.calib_rt_cfg);

1694
	ieee80211_wake_queues(priv->hw);
Z
Zhu Yi 已提交
1695

1696
	priv->active_rate = IWL_RATES_MASK;
Z
Zhu Yi 已提交
1697

1698
	/* Configure Tx antenna selection based on H/W config */
W
Wey-Yi Guy 已提交
1699
	iwlagn_send_tx_ant_config(priv, priv->cfg->valid_tx_ant);
1700

1701
	if (iwl_is_associated_ctx(ctx)) {
G
Gregory Greenman 已提交
1702
		struct iwl_rxon_cmd *active_rxon =
1703
				(struct iwl_rxon_cmd *)&ctx->active;
1704
		/* apply any changes in staging */
1705
		ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
Z
Zhu Yi 已提交
1706 1707
		active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
	} else {
1708
		struct iwl_rxon_context *tmp;
Z
Zhu Yi 已提交
1709
		/* Initialize our rx_config data */
1710 1711
		for_each_context(priv, tmp)
			iwl_connection_init_rx_config(priv, tmp);
1712

W
Wey-Yi Guy 已提交
1713
		iwlagn_set_rxon_chain(priv, ctx);
Z
Zhu Yi 已提交
1714 1715
	}

1716 1717
	iwl_reset_run_time_calib(priv);

1718 1719
	set_bit(STATUS_READY, &priv->status);

Z
Zhu Yi 已提交
1720
	/* Configure the adapter for unassociated operation */
1721
	ret = iwlagn_commit_rxon(priv, ctx);
1722 1723
	if (ret)
		return ret;
Z
Zhu Yi 已提交
1724 1725

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

1728
	IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
1729

1730
	return iwl_power_update_mode(priv, true);
Z
Zhu Yi 已提交
1731 1732
}

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

1735
static void __iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1736
{
1737
	int exit_pending;
Z
Zhu Yi 已提交
1738

1739
	IWL_DEBUG_INFO(priv, DRV_NAME " is going down\n");
Z
Zhu Yi 已提交
1740

1741 1742 1743
	iwl_scan_cancel_timeout(priv, 200);

	exit_pending = test_and_set_bit(STATUS_EXIT_PENDING, &priv->status);
Z
Zhu Yi 已提交
1744

1745 1746
	/* Stop TX queues watchdog. We need to have STATUS_EXIT_PENDING bit set
	 * to prevent rearm timer */
1747
	del_timer_sync(&priv->watchdog);
1748

1749
	iwl_clear_ucode_stations(priv, NULL);
1750
	iwl_dealloc_bcast_stations(priv);
1751
	iwl_clear_driver_stations(priv);
Z
Zhu Yi 已提交
1752

1753
	/* reset BT coex data */
1754
	priv->bt_status = 0;
1755 1756
	priv->cur_rssi_ctx = NULL;
	priv->bt_is_sco = 0;
1757 1758 1759 1760 1761
	if (priv->cfg->bt_params)
		priv->bt_traffic_load =
			 priv->cfg->bt_params->bt_init_traffic_load;
	else
		priv->bt_traffic_load = 0;
1762 1763
	priv->bt_full_concurrent = false;
	priv->bt_ci_compliance = 0;
1764

Z
Zhu Yi 已提交
1765 1766 1767 1768 1769 1770 1771 1772
	/* 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);

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

J
Johannes Berg 已提交
1773
	/* Clear out all status bits but a few that are stable across reset */
Z
Zhu Yi 已提交
1774 1775
	priv->status &= test_bit(STATUS_RF_KILL_HW, &priv->status) <<
				STATUS_RF_KILL_HW |
1776 1777
			test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
				STATUS_GEO_CONFIGURED |
Z
Zhu Yi 已提交
1778
			test_bit(STATUS_FW_ERROR, &priv->status) <<
1779 1780 1781
				STATUS_FW_ERROR |
		       test_bit(STATUS_EXIT_PENDING, &priv->status) <<
				STATUS_EXIT_PENDING;
Z
Zhu Yi 已提交
1782

1783
	trans_stop_device(&priv->trans);
1784

1785
	dev_kfree_skb(priv->beacon_skb);
1786
	priv->beacon_skb = NULL;
Z
Zhu Yi 已提交
1787 1788
}

1789
static void iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1790 1791
{
	mutex_lock(&priv->mutex);
1792
	__iwl_down(priv);
Z
Zhu Yi 已提交
1793
	mutex_unlock(&priv->mutex);
1794

1795
	iwl_cancel_deferred_work(priv);
Z
Zhu Yi 已提交
1796 1797 1798 1799
}

#define MAX_HW_RESTARTS 5

1800
static int __iwl_up(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1801
{
1802
	struct iwl_rxon_context *ctx;
1803
	int ret;
Z
Zhu Yi 已提交
1804

1805 1806
	lockdep_assert_held(&priv->mutex);

Z
Zhu Yi 已提交
1807
	if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
1808
		IWL_WARN(priv, "Exit pending; will not bring the NIC up\n");
Z
Zhu Yi 已提交
1809 1810 1811
		return -EIO;
	}

1812
	for_each_context(priv, ctx) {
1813
		ret = iwlagn_alloc_bcast_station(priv, ctx);
1814 1815 1816 1817 1818
		if (ret) {
			iwl_dealloc_bcast_stations(priv);
			return ret;
		}
	}
1819

1820 1821 1822 1823 1824
	ret = iwlagn_run_init_ucode(priv);
	if (ret) {
		IWL_ERR(priv, "Failed to run INIT ucode: %d\n", ret);
		goto error;
	}
Z
Zhu Yi 已提交
1825

1826
	ret = iwlagn_load_ucode_wait_alive(priv,
1827
					   &priv->ucode_rt,
1828
					   IWL_UCODE_REGULAR);
1829 1830 1831
	if (ret) {
		IWL_ERR(priv, "Failed to start RT ucode: %d\n", ret);
		goto error;
Z
Zhu Yi 已提交
1832 1833
	}

1834 1835 1836 1837 1838 1839
	ret = iwl_alive_start(priv);
	if (ret)
		goto error;
	return 0;

 error:
Z
Zhu Yi 已提交
1840
	set_bit(STATUS_EXIT_PENDING, &priv->status);
1841
	__iwl_down(priv);
M
Mohamed Abbas 已提交
1842
	clear_bit(STATUS_EXIT_PENDING, &priv->status);
Z
Zhu Yi 已提交
1843

1844 1845
	IWL_ERR(priv, "Unable to initialize device.\n");
	return ret;
Z
Zhu Yi 已提交
1846 1847 1848 1849 1850 1851 1852 1853 1854
}


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

1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868
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) {
1869 1870
		iwl_chain_noise_calibration(priv);
		iwl_sensitivity_calibration(priv);
1871 1872 1873 1874 1875
	}

	mutex_unlock(&priv->mutex);
}

J
Johannes Berg 已提交
1876 1877 1878 1879 1880 1881 1882
static void iwlagn_prepare_restart(struct iwl_priv *priv)
{
	struct iwl_rxon_context *ctx;
	bool bt_full_concurrent;
	u8 bt_ci_compliance;
	u8 bt_load;
	u8 bt_status;
1883
	bool bt_is_sco;
J
Johannes Berg 已提交
1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903

	lockdep_assert_held(&priv->mutex);

	for_each_context(priv, ctx)
		ctx->vif = NULL;
	priv->is_open = 0;

	/*
	 * __iwl_down() will clear the BT status variables,
	 * which is correct, but when we restart we really
	 * want to keep them so restore them afterwards.
	 *
	 * The restart process will later pick them up and
	 * re-configure the hw when we reconfigure the BT
	 * command.
	 */
	bt_full_concurrent = priv->bt_full_concurrent;
	bt_ci_compliance = priv->bt_ci_compliance;
	bt_load = priv->bt_traffic_load;
	bt_status = priv->bt_status;
1904
	bt_is_sco = priv->bt_is_sco;
J
Johannes Berg 已提交
1905 1906 1907 1908 1909 1910 1911

	__iwl_down(priv);

	priv->bt_full_concurrent = bt_full_concurrent;
	priv->bt_ci_compliance = bt_ci_compliance;
	priv->bt_traffic_load = bt_load;
	priv->bt_status = bt_status;
1912
	priv->bt_is_sco = bt_is_sco;
J
Johannes Berg 已提交
1913 1914
}

1915
static void iwl_bg_restart(struct work_struct *data)
Z
Zhu Yi 已提交
1916
{
1917
	struct iwl_priv *priv = container_of(data, struct iwl_priv, restart);
Z
Zhu Yi 已提交
1918 1919 1920 1921

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

J
Johannes Berg 已提交
1922 1923
	if (test_and_clear_bit(STATUS_FW_ERROR, &priv->status)) {
		mutex_lock(&priv->mutex);
J
Johannes Berg 已提交
1924
		iwlagn_prepare_restart(priv);
J
Johannes Berg 已提交
1925
		mutex_unlock(&priv->mutex);
1926
		iwl_cancel_deferred_work(priv);
J
Johannes Berg 已提交
1927 1928
		ieee80211_restart_hw(priv->hw);
	} else {
1929
		WARN_ON(1);
J
Johannes Berg 已提交
1930
	}
Z
Zhu Yi 已提交
1931 1932
}

J
Johannes Berg 已提交
1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966
static int iwl_mac_offchannel_tx(struct ieee80211_hw *hw, struct sk_buff *skb,
				 struct ieee80211_channel *chan,
				 enum nl80211_channel_type channel_type,
				 unsigned int wait)
{
	struct iwl_priv *priv = hw->priv;
	int ret;

	/* Not supported if we don't have PAN */
	if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN))) {
		ret = -EOPNOTSUPP;
		goto free;
	}

	/* Not supported on pre-P2P firmware */
	if (!(priv->contexts[IWL_RXON_CTX_PAN].interface_modes &
					BIT(NL80211_IFTYPE_P2P_CLIENT))) {
		ret = -EOPNOTSUPP;
		goto free;
	}

	mutex_lock(&priv->mutex);

	if (!priv->contexts[IWL_RXON_CTX_PAN].is_active) {
		/*
		 * If the PAN context is free, use the normal
		 * way of doing remain-on-channel offload + TX.
		 */
		ret = 1;
		goto out;
	}

	/* TODO: queue up if scanning? */
	if (test_bit(STATUS_SCANNING, &priv->status) ||
W
Wey-Yi Guy 已提交
1967
	    priv->offchan_tx_skb) {
J
Johannes Berg 已提交
1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980
		ret = -EBUSY;
		goto out;
	}

	/*
	 * max_scan_ie_len doesn't include the blank SSID or the header,
	 * so need to add that again here.
	 */
	if (skb->len > hw->wiphy->max_scan_ie_len + 24 + 2) {
		ret = -ENOBUFS;
		goto out;
	}

W
Wey-Yi Guy 已提交
1981 1982 1983
	priv->offchan_tx_skb = skb;
	priv->offchan_tx_timeout = wait;
	priv->offchan_tx_chan = chan;
J
Johannes Berg 已提交
1984 1985 1986 1987

	ret = iwl_scan_initiate(priv, priv->contexts[IWL_RXON_CTX_PAN].vif,
				IWL_SCAN_OFFCH_TX, chan->band);
	if (ret)
W
Wey-Yi Guy 已提交
1988
		priv->offchan_tx_skb = NULL;
J
Johannes Berg 已提交
1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004
 out:
	mutex_unlock(&priv->mutex);
 free:
	if (ret < 0)
		kfree_skb(skb);

	return ret;
}

static int iwl_mac_offchannel_tx_cancel_wait(struct ieee80211_hw *hw)
{
	struct iwl_priv *priv = hw->priv;
	int ret;

	mutex_lock(&priv->mutex);

W
Wey-Yi Guy 已提交
2005
	if (!priv->offchan_tx_skb) {
2006 2007 2008
		ret = -EINVAL;
		goto unlock;
	}
J
Johannes Berg 已提交
2009

W
Wey-Yi Guy 已提交
2010
	priv->offchan_tx_skb = NULL;
J
Johannes Berg 已提交
2011 2012 2013 2014

	ret = iwl_scan_cancel_timeout(priv, 200);
	if (ret)
		ret = -EIO;
2015
unlock:
J
Johannes Berg 已提交
2016 2017 2018 2019 2020
	mutex_unlock(&priv->mutex);

	return ret;
}

Z
Zhu Yi 已提交
2021 2022 2023 2024 2025 2026
/*****************************************************************************
 *
 * mac80211 entry point functions
 *
 *****************************************************************************/

2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097
static const struct ieee80211_iface_limit iwlagn_sta_ap_limits[] = {
	{
		.max = 1,
		.types = BIT(NL80211_IFTYPE_STATION),
	},
	{
		.max = 1,
		.types = BIT(NL80211_IFTYPE_AP),
	},
};

static const struct ieee80211_iface_limit iwlagn_2sta_limits[] = {
	{
		.max = 2,
		.types = BIT(NL80211_IFTYPE_STATION),
	},
};

static const struct ieee80211_iface_limit iwlagn_p2p_sta_go_limits[] = {
	{
		.max = 1,
		.types = BIT(NL80211_IFTYPE_STATION),
	},
	{
		.max = 1,
		.types = BIT(NL80211_IFTYPE_P2P_GO) |
			 BIT(NL80211_IFTYPE_AP),
	},
};

static const struct ieee80211_iface_limit iwlagn_p2p_2sta_limits[] = {
	{
		.max = 2,
		.types = BIT(NL80211_IFTYPE_STATION),
	},
	{
		.max = 1,
		.types = BIT(NL80211_IFTYPE_P2P_CLIENT),
	},
};

static const struct ieee80211_iface_combination
iwlagn_iface_combinations_dualmode[] = {
	{ .num_different_channels = 1,
	  .max_interfaces = 2,
	  .beacon_int_infra_match = true,
	  .limits = iwlagn_sta_ap_limits,
	  .n_limits = ARRAY_SIZE(iwlagn_sta_ap_limits),
	},
	{ .num_different_channels = 1,
	  .max_interfaces = 2,
	  .limits = iwlagn_2sta_limits,
	  .n_limits = ARRAY_SIZE(iwlagn_2sta_limits),
	},
};

static const struct ieee80211_iface_combination
iwlagn_iface_combinations_p2p[] = {
	{ .num_different_channels = 1,
	  .max_interfaces = 2,
	  .beacon_int_infra_match = true,
	  .limits = iwlagn_p2p_sta_go_limits,
	  .n_limits = ARRAY_SIZE(iwlagn_p2p_sta_go_limits),
	},
	{ .num_different_channels = 1,
	  .max_interfaces = 2,
	  .limits = iwlagn_p2p_2sta_limits,
	  .n_limits = ARRAY_SIZE(iwlagn_p2p_2sta_limits),
	},
};

2098 2099 2100 2101
/*
 * Not a mac80211 entry point function, but it fits in with all the
 * other mac80211 functions grouped here.
 */
2102 2103
static int iwl_mac_setup_register(struct iwl_priv *priv,
				  struct iwlagn_ucode_capabilities *capa)
2104 2105 2106
{
	int ret;
	struct ieee80211_hw *hw = priv->hw;
2107 2108
	struct iwl_rxon_context *ctx;

2109 2110 2111 2112 2113
	hw->rate_control_algorithm = "iwl-agn-rs";

	/* Tell mac80211 our characteristics */
	hw->flags = IEEE80211_HW_SIGNAL_DBM |
		    IEEE80211_HW_AMPDU_AGGREGATION |
2114
		    IEEE80211_HW_NEED_DTIM_PERIOD |
2115 2116
		    IEEE80211_HW_SPECTRUM_MGMT |
		    IEEE80211_HW_REPORTS_TX_ACK_STATUS;
2117

2118 2119
	hw->max_tx_aggregation_subframes = LINK_QUAL_AGG_FRAME_LIMIT_DEF;

2120 2121
	hw->flags |= IEEE80211_HW_SUPPORTS_PS |
		     IEEE80211_HW_SUPPORTS_DYNAMIC_PS;
2122

2123
	if (priv->cfg->sku & EEPROM_SKU_CAP_11N_ENABLE)
J
Johannes Berg 已提交
2124 2125 2126
		hw->flags |= IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS |
			     IEEE80211_HW_SUPPORTS_STATIC_SMPS;

J
Johannes Berg 已提交
2127 2128 2129
	if (capa->flags & IWL_UCODE_TLV_FLAGS_MFP)
		hw->flags |= IEEE80211_HW_MFP_CAPABLE;

2130
	hw->sta_data_size = sizeof(struct iwl_station_priv);
J
Johannes Berg 已提交
2131 2132
	hw->vif_data_size = sizeof(struct iwl_vif_priv);

2133 2134 2135 2136
	for_each_context(priv, ctx) {
		hw->wiphy->interface_modes |= ctx->interface_modes;
		hw->wiphy->interface_modes |= ctx->exclusive_interface_modes;
	}
2137

2138 2139
	BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);

2140
	if (hw->wiphy->interface_modes & BIT(NL80211_IFTYPE_P2P_CLIENT)) {
2141 2142 2143
		hw->wiphy->iface_combinations = iwlagn_iface_combinations_p2p;
		hw->wiphy->n_iface_combinations =
			ARRAY_SIZE(iwlagn_iface_combinations_p2p);
2144
	} else if (hw->wiphy->interface_modes & BIT(NL80211_IFTYPE_AP)) {
2145 2146 2147 2148 2149
		hw->wiphy->iface_combinations = iwlagn_iface_combinations_dualmode;
		hw->wiphy->n_iface_combinations =
			ARRAY_SIZE(iwlagn_iface_combinations_dualmode);
	}

2150 2151
	hw->wiphy->max_remain_on_channel_duration = 1000;

R
Reinette Chatre 已提交
2152
	hw->wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY |
J
Johannes Berg 已提交
2153 2154
			    WIPHY_FLAG_DISABLE_BEACON_HINTS |
			    WIPHY_FLAG_IBSS_RSN;
2155

2156 2157 2158 2159
	if (iwlagn_mod_params.power_save)
		hw->wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
	else
		hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
2160

2161
	hw->wiphy->max_scan_ssids = PROBE_OPTION_MAX;
2162
	/* we create the 802.11 header and a zero-length SSID element */
2163
	hw->wiphy->max_scan_ie_len = capa->max_probe_length - 24 - 2;
2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176

	/* 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];

2177 2178
	iwl_leds_init(priv);

2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189
	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;
}


2190
static int iwlagn_mac_start(struct ieee80211_hw *hw)
Z
Zhu Yi 已提交
2191
{
2192
	struct iwl_priv *priv = hw->priv;
2193
	int ret;
Z
Zhu Yi 已提交
2194

2195
	IWL_DEBUG_MAC80211(priv, "enter\n");
Z
Zhu Yi 已提交
2196 2197 2198

	/* we should be verifying the device is ready to be opened */
	mutex_lock(&priv->mutex);
2199
	ret = __iwl_up(priv);
Z
Zhu Yi 已提交
2200
	mutex_unlock(&priv->mutex);
2201
	if (ret)
2202
		return ret;
2203

2204
	IWL_DEBUG_INFO(priv, "Start UP work done.\n");
2205

2206 2207 2208
	/* Now we should be done, and the READY bit should be set. */
	if (WARN_ON(!test_bit(STATUS_READY, &priv->status)))
		ret = -EIO;
T
Tomas Winkler 已提交
2209

2210
	iwlagn_led_enable(priv);
J
Johannes Berg 已提交
2211

T
Tomas Winkler 已提交
2212
	priv->is_open = 1;
2213
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2214 2215 2216
	return 0;
}

2217
static void iwlagn_mac_stop(struct ieee80211_hw *hw)
Z
Zhu Yi 已提交
2218
{
2219
	struct iwl_priv *priv = hw->priv;
Z
Zhu Yi 已提交
2220

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

J
Johannes Berg 已提交
2223
	if (!priv->is_open)
2224 2225
		return;

Z
Zhu Yi 已提交
2226
	priv->is_open = 0;
2227

2228
	iwl_down(priv);
2229 2230

	flush_workqueue(priv->workqueue);
2231

2232 2233
	/* User space software may expect getting rfkill changes
	 * even if interface is down */
2234
	iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
2235
	iwl_enable_rfkill_int(priv);
M
Mohamed Abbas 已提交
2236

2237
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2238 2239
}

2240
static void iwlagn_mac_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
Z
Zhu Yi 已提交
2241
{
2242
	struct iwl_priv *priv = hw->priv;
Z
Zhu Yi 已提交
2243

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

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

2249
	if (iwlagn_tx_skb(priv, skb))
Z
Zhu Yi 已提交
2250 2251
		dev_kfree_skb_any(skb);

2252
	IWL_DEBUG_MACDUMP(priv, "leave\n");
Z
Zhu Yi 已提交
2253 2254
}

2255 2256 2257 2258 2259
static void iwlagn_mac_update_tkip_key(struct ieee80211_hw *hw,
				       struct ieee80211_vif *vif,
				       struct ieee80211_key_conf *keyconf,
				       struct ieee80211_sta *sta,
				       u32 iv32, u16 *phase1key)
2260
{
2261
	struct iwl_priv *priv = hw->priv;
2262

J
Johannes Berg 已提交
2263
	iwl_update_tkip_key(priv, vif, keyconf, sta, iv32, phase1key);
2264 2265
}

2266 2267 2268 2269
static int iwlagn_mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
			      struct ieee80211_vif *vif,
			      struct ieee80211_sta *sta,
			      struct ieee80211_key_conf *key)
Z
Zhu Yi 已提交
2270
{
2271
	struct iwl_priv *priv = hw->priv;
2272
	struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
2273
	struct iwl_rxon_context *ctx = vif_priv->ctx;
2274 2275
	int ret;
	bool is_default_wep_key = false;
Z
Zhu Yi 已提交
2276

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

D
Don Fry 已提交
2279
	if (iwlagn_mod_params.sw_crypto) {
2280
		IWL_DEBUG_MAC80211(priv, "leave - hwcrypto disabled\n");
Z
Zhu Yi 已提交
2281 2282 2283
		return -EOPNOTSUPP;
	}

J
Johannes Berg 已提交
2284
	/*
J
Johannes Berg 已提交
2285 2286 2287 2288 2289
	 * We could program these keys into the hardware as well, but we
	 * don't expect much multicast traffic in IBSS and having keys
	 * for more stations is probably more useful.
	 *
	 * Mark key TX-only and return 0.
J
Johannes Berg 已提交
2290 2291
	 */
	if (vif->type == NL80211_IFTYPE_ADHOC &&
J
Johannes Berg 已提交
2292 2293 2294 2295
	    !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
		key->hw_key_idx = WEP_INVALID_OFFSET;
		return 0;
	}
J
Johannes Berg 已提交
2296

J
Johannes Berg 已提交
2297 2298 2299
	/* If they key was TX-only, accept deletion */
	if (cmd == DISABLE_KEY && key->hw_key_idx == WEP_INVALID_OFFSET)
		return 0;
Z
Zhu Yi 已提交
2300

2301
	mutex_lock(&priv->mutex);
2302
	iwl_scan_cancel_timeout(priv, 100);
2303

J
Johannes Berg 已提交
2304 2305
	BUILD_BUG_ON(WEP_INVALID_OFFSET == IWLAGN_HW_KEY_DEFAULT);

J
Johannes Berg 已提交
2306 2307
	/*
	 * If we are getting WEP group key and we didn't receive any key mapping
2308 2309
	 * so far, we are in legacy wep mode (group key only), otherwise we are
	 * in 1X mode.
J
Johannes Berg 已提交
2310 2311
	 * In legacy wep mode, we use another host command to the uCode.
	 */
2312
	if ((key->cipher == WLAN_CIPHER_SUITE_WEP40 ||
J
Johannes Berg 已提交
2313
	     key->cipher == WLAN_CIPHER_SUITE_WEP104) && !sta) {
2314
		if (cmd == SET_KEY)
2315
			is_default_wep_key = !ctx->key_mapping_keys;
2316
		else
2317
			is_default_wep_key =
J
Johannes Berg 已提交
2318
				key->hw_key_idx == IWLAGN_HW_KEY_DEFAULT;
2319
	}
2320

J
Johannes Berg 已提交
2321

Z
Zhu Yi 已提交
2322
	switch (cmd) {
2323
	case SET_KEY:
J
Johannes Berg 已提交
2324
		if (is_default_wep_key) {
2325
			ret = iwl_set_default_wep_key(priv, vif_priv->ctx, key);
J
Johannes Berg 已提交
2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
			break;
		}
		ret = iwl_set_dynamic_key(priv, vif_priv->ctx, key, sta);
		if (ret) {
			/*
			 * can't add key for RX, but we don't need it
			 * in the device for TX so still return 0
			 */
			ret = 0;
			key->hw_key_idx = WEP_INVALID_OFFSET;
		}
2337

2338
		IWL_DEBUG_MAC80211(priv, "enable hwcrypto key\n");
Z
Zhu Yi 已提交
2339 2340
		break;
	case DISABLE_KEY:
2341
		if (is_default_wep_key)
2342
			ret = iwl_remove_default_wep_key(priv, ctx, key);
2343
		else
J
Johannes Berg 已提交
2344
			ret = iwl_remove_dynamic_key(priv, ctx, key, sta);
2345

2346
		IWL_DEBUG_MAC80211(priv, "disable hwcrypto key\n");
Z
Zhu Yi 已提交
2347 2348
		break;
	default:
2349
		ret = -EINVAL;
Z
Zhu Yi 已提交
2350 2351
	}

2352
	mutex_unlock(&priv->mutex);
2353
	IWL_DEBUG_MAC80211(priv, "leave\n");
Z
Zhu Yi 已提交
2354

2355
	return ret;
Z
Zhu Yi 已提交
2356 2357
}

2358 2359 2360 2361 2362
static int iwlagn_mac_ampdu_action(struct ieee80211_hw *hw,
				   struct ieee80211_vif *vif,
				   enum ieee80211_ampdu_mlme_action action,
				   struct ieee80211_sta *sta, u16 tid, u16 *ssn,
				   u8 buf_size)
2363 2364
{
	struct iwl_priv *priv = hw->priv;
2365
	int ret = -EINVAL;
2366
	struct iwl_station_priv *sta_priv = (void *) sta->drv_priv;
2367

2368
	IWL_DEBUG_HT(priv, "A-MPDU action on addr %pM tid %d\n",
J
Johannes Berg 已提交
2369
		     sta->addr, tid);
2370

2371
	if (!(priv->cfg->sku & EEPROM_SKU_CAP_11N_ENABLE))
2372 2373
		return -EACCES;

2374 2375
	mutex_lock(&priv->mutex);

2376 2377
	switch (action) {
	case IEEE80211_AMPDU_RX_START:
2378
		IWL_DEBUG_HT(priv, "start Rx\n");
2379 2380
		ret = iwl_sta_rx_agg_start(priv, sta, tid, *ssn);
		break;
2381
	case IEEE80211_AMPDU_RX_STOP:
2382
		IWL_DEBUG_HT(priv, "stop Rx\n");
2383
		ret = iwl_sta_rx_agg_stop(priv, sta, tid);
2384
		if (test_bit(STATUS_EXIT_PENDING, &priv->status))
2385 2386
			ret = 0;
		break;
2387
	case IEEE80211_AMPDU_TX_START:
2388
		IWL_DEBUG_HT(priv, "start Tx\n");
2389
		ret = iwlagn_tx_agg_start(priv, vif, sta, tid, ssn);
W
Wey-Yi Guy 已提交
2390
		if (ret == 0) {
W
Wey-Yi Guy 已提交
2391 2392 2393
			priv->agg_tids_count++;
			IWL_DEBUG_HT(priv, "priv->agg_tids_count = %u\n",
				     priv->agg_tids_count);
W
Wey-Yi Guy 已提交
2394
		}
2395
		break;
2396
	case IEEE80211_AMPDU_TX_STOP:
2397
		IWL_DEBUG_HT(priv, "stop Tx\n");
2398
		ret = iwlagn_tx_agg_stop(priv, vif, sta, tid);
W
Wey-Yi Guy 已提交
2399 2400 2401 2402
		if ((ret == 0) && (priv->agg_tids_count > 0)) {
			priv->agg_tids_count--;
			IWL_DEBUG_HT(priv, "priv->agg_tids_count = %u\n",
				     priv->agg_tids_count);
W
Wey-Yi Guy 已提交
2403
		}
2404
		if (test_bit(STATUS_EXIT_PENDING, &priv->status))
2405
			ret = 0;
2406 2407
		if (priv->cfg->ht_params &&
		    priv->cfg->ht_params->use_rts_for_aggregation) {
J
Johannes Berg 已提交
2408 2409 2410 2411 2412
			/*
			 * switch off RTS/CTS if it was previously enabled
			 */
			sta_priv->lq_sta.lq.general_params.flags &=
				~LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
2413 2414
			iwl_send_lq_cmd(priv, iwl_rxon_ctx_from_vif(vif),
					&sta_priv->lq_sta.lq, CMD_ASYNC, false);
J
Johannes Berg 已提交
2415
		}
2416
		break;
2417
	case IEEE80211_AMPDU_TX_OPERATIONAL:
2418 2419
		buf_size = min_t(int, buf_size, LINK_QUAL_AGG_FRAME_LIMIT_DEF);

2420 2421
		trans_txq_agg_setup(&priv->trans, iwl_sta_id(sta), tid,
				buf_size);
2422

2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442
		/*
		 * If the limit is 0, then it wasn't initialised yet,
		 * use the default. We can do that since we take the
		 * minimum below, and we don't want to go above our
		 * default due to hardware restrictions.
		 */
		if (sta_priv->max_agg_bufsize == 0)
			sta_priv->max_agg_bufsize =
				LINK_QUAL_AGG_FRAME_LIMIT_DEF;

		/*
		 * Even though in theory the peer could have different
		 * aggregation reorder buffer sizes for different sessions,
		 * our ucode doesn't allow for that and has a global limit
		 * for each station. Therefore, use the minimum of all the
		 * aggregation sessions and our default value.
		 */
		sta_priv->max_agg_bufsize =
			min(sta_priv->max_agg_bufsize, buf_size);

2443 2444
		if (priv->cfg->ht_params &&
		    priv->cfg->ht_params->use_rts_for_aggregation) {
2445 2446 2447 2448
			/*
			 * switch to RTS/CTS if it is the prefer protection
			 * method for HT traffic
			 */
J
Johannes Berg 已提交
2449 2450 2451

			sta_priv->lq_sta.lq.general_params.flags |=
				LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
2452
		}
2453 2454 2455 2456 2457 2458

		sta_priv->lq_sta.lq.agg_params.agg_frame_cnt_limit =
			sta_priv->max_agg_bufsize;

		iwl_send_lq_cmd(priv, iwl_rxon_ctx_from_vif(vif),
				&sta_priv->lq_sta.lq, CMD_ASYNC, false);
2459 2460 2461

		IWL_INFO(priv, "Tx aggregation enabled on ra = %pM tid = %d\n",
			 sta->addr, tid);
2462
		ret = 0;
2463 2464
		break;
	}
2465 2466 2467
	mutex_unlock(&priv->mutex);

	return ret;
2468
}
2469

2470 2471 2472
static int iwlagn_mac_sta_add(struct ieee80211_hw *hw,
			      struct ieee80211_vif *vif,
			      struct ieee80211_sta *sta)
2473 2474 2475
{
	struct iwl_priv *priv = hw->priv;
	struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
2476
	struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
2477
	bool is_ap = vif->type == NL80211_IFTYPE_STATION;
2478 2479 2480 2481 2482
	int ret;
	u8 sta_id;

	IWL_DEBUG_INFO(priv, "received request to add station %pM\n",
			sta->addr);
2483 2484 2485 2486
	mutex_lock(&priv->mutex);
	IWL_DEBUG_INFO(priv, "proceeding to add station %pM\n",
			sta->addr);
	sta_priv->common.sta_id = IWL_INVALID_STATION;
2487 2488 2489 2490 2491

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

2492
	ret = iwl_add_station_common(priv, vif_priv->ctx, sta->addr,
2493
				     is_ap, sta, &sta_id);
2494 2495 2496 2497
	if (ret) {
		IWL_ERR(priv, "Unable to add station %pM (%d)\n",
			sta->addr, ret);
		/* Should we return success if return code is EEXIST ? */
2498
		mutex_unlock(&priv->mutex);
2499 2500 2501
		return ret;
	}

J
Johannes Berg 已提交
2502 2503
	sta_priv->common.sta_id = sta_id;

2504
	/* Initialize rate scaling */
2505
	IWL_DEBUG_INFO(priv, "Initializing rate scaling for station %pM\n",
2506 2507
		       sta->addr);
	iwl_rs_rate_init(priv, sta, sta_id);
2508
	mutex_unlock(&priv->mutex);
2509

J
Johannes Berg 已提交
2510
	return 0;
2511 2512
}

2513 2514
static void iwlagn_mac_channel_switch(struct ieee80211_hw *hw,
				struct ieee80211_channel_switch *ch_switch)
2515 2516 2517 2518
{
	struct iwl_priv *priv = hw->priv;
	const struct iwl_channel_info *ch_info;
	struct ieee80211_conf *conf = &hw->conf;
2519
	struct ieee80211_channel *channel = ch_switch->channel;
2520
	struct iwl_ht_config *ht_conf = &priv->current_ht_config;
2521 2522 2523 2524 2525 2526 2527 2528 2529
	/*
	 * MULTI-FIXME
	 * When we add support for multiple interfaces, we need to
	 * revisit this. The channel switch command in the device
	 * only affects the BSS context, but what does that really
	 * mean? And what if we get a CSA on the second interface?
	 * This needs a lot of work.
	 */
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
2530 2531 2532 2533
	u16 ch;

	IWL_DEBUG_MAC80211(priv, "enter\n");

2534 2535
	mutex_lock(&priv->mutex);

2536
	if (iwl_is_rfkill(priv))
2537
		goto out;
2538 2539

	if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
2540 2541
	    test_bit(STATUS_SCANNING, &priv->status) ||
	    test_bit(STATUS_CHANNEL_SWITCH_PENDING, &priv->status))
2542
		goto out;
2543

2544
	if (!iwl_is_associated_ctx(ctx))
2545
		goto out;
2546

2547
	if (!priv->cfg->lib->set_channel_switch)
2548
		goto out;
2549

2550 2551 2552 2553 2554 2555 2556 2557 2558
	ch = channel->hw_value;
	if (le16_to_cpu(ctx->active.channel) == ch)
		goto out;

	ch_info = iwl_get_channel_info(priv, channel->band, ch);
	if (!is_channel_valid(ch_info)) {
		IWL_DEBUG_MAC80211(priv, "invalid channel\n");
		goto out;
	}
2559

2560
	spin_lock_irq(&priv->lock);
2561

2562
	priv->current_ht_config.smps = conf->smps_mode;
2563

2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578
	/* Configure HT40 channels */
	ctx->ht.enabled = conf_is_ht(conf);
	if (ctx->ht.enabled) {
		if (conf_is_ht40_minus(conf)) {
			ctx->ht.extension_chan_offset =
				IEEE80211_HT_PARAM_CHA_SEC_BELOW;
			ctx->ht.is_40mhz = true;
		} else if (conf_is_ht40_plus(conf)) {
			ctx->ht.extension_chan_offset =
				IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
			ctx->ht.is_40mhz = true;
		} else {
			ctx->ht.extension_chan_offset =
				IEEE80211_HT_PARAM_CHA_SEC_NONE;
			ctx->ht.is_40mhz = false;
2579
		}
2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598
	} else
		ctx->ht.is_40mhz = false;

	if ((le16_to_cpu(ctx->staging.channel) != ch))
		ctx->staging.flags = 0;

	iwl_set_rxon_channel(priv, channel, ctx);
	iwl_set_rxon_ht(priv, ht_conf);
	iwl_set_flags_for_band(priv, ctx, channel->band, ctx->vif);

	spin_unlock_irq(&priv->lock);

	iwl_set_rate(priv);
	/*
	 * at this point, staging_rxon has the
	 * configuration for channel switch
	 */
	set_bit(STATUS_CHANNEL_SWITCH_PENDING, &priv->status);
	priv->switch_channel = cpu_to_le16(ch);
2599
	if (priv->cfg->lib->set_channel_switch(priv, ch_switch)) {
2600 2601 2602
		clear_bit(STATUS_CHANNEL_SWITCH_PENDING, &priv->status);
		priv->switch_channel = 0;
		ieee80211_chswitch_done(ctx->vif, false);
2603
	}
2604

2605 2606 2607 2608 2609
out:
	mutex_unlock(&priv->mutex);
	IWL_DEBUG_MAC80211(priv, "leave\n");
}

2610 2611 2612 2613
static void iwlagn_configure_filter(struct ieee80211_hw *hw,
				    unsigned int changed_flags,
				    unsigned int *total_flags,
				    u64 multicast)
J
Johannes Berg 已提交
2614 2615 2616
{
	struct iwl_priv *priv = hw->priv;
	__le32 filter_or = 0, filter_nand = 0;
2617
	struct iwl_rxon_context *ctx;
J
Johannes Berg 已提交
2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629

#define CHK(test, flag)	do { \
	if (*total_flags & (test))		\
		filter_or |= (flag);		\
	else					\
		filter_nand |= (flag);		\
	} while (0)

	IWL_DEBUG_MAC80211(priv, "Enter: changed: 0x%x, total: 0x%x\n",
			changed_flags, *total_flags);

	CHK(FIF_OTHER_BSS | FIF_PROMISC_IN_BSS, RXON_FILTER_PROMISC_MSK);
J
Johannes Berg 已提交
2630 2631
	/* Setting _just_ RXON_FILTER_CTL2HOST_MSK causes FH errors */
	CHK(FIF_CONTROL, RXON_FILTER_CTL2HOST_MSK | RXON_FILTER_PROMISC_MSK);
J
Johannes Berg 已提交
2632 2633 2634 2635 2636 2637
	CHK(FIF_BCN_PRBRESP_PROMISC, RXON_FILTER_BCON_AWARE_MSK);

#undef CHK

	mutex_lock(&priv->mutex);

2638 2639 2640
	for_each_context(priv, ctx) {
		ctx->staging.filter_flags &= ~filter_nand;
		ctx->staging.filter_flags |= filter_or;
2641 2642 2643 2644 2645

		/*
		 * Not committing directly because hardware can perform a scan,
		 * but we'll eventually commit the filter flags change anyway.
		 */
2646
	}
J
Johannes Berg 已提交
2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659

	mutex_unlock(&priv->mutex);

	/*
	 * Receiving all multicast frames is always enabled by the
	 * default flags setup in iwl_connection_init_rx_config()
	 * since we currently do not support programming multicast
	 * filters into the device.
	 */
	*total_flags &= FIF_OTHER_BSS | FIF_ALLMULTI | FIF_PROMISC_IN_BSS |
			FIF_BCN_PRBRESP_PROMISC | FIF_CONTROL;
}

2660
static void iwlagn_mac_flush(struct ieee80211_hw *hw, bool drop)
2661 2662 2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681
{
	struct iwl_priv *priv = hw->priv;

	mutex_lock(&priv->mutex);
	IWL_DEBUG_MAC80211(priv, "enter\n");

	if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
		IWL_DEBUG_TX(priv, "Aborting flush due to device shutdown\n");
		goto done;
	}
	if (iwl_is_rfkill(priv)) {
		IWL_DEBUG_TX(priv, "Aborting flush due to RF Kill\n");
		goto done;
	}

	/*
	 * mac80211 will not push any more frames for transmit
	 * until the flush is completed
	 */
	if (drop) {
		IWL_DEBUG_MAC80211(priv, "send flush command\n");
2682
		if (iwlagn_txfifo_flush(priv, IWL_DROP_ALL)) {
2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693
			IWL_ERR(priv, "flush request fail\n");
			goto done;
		}
	}
	IWL_DEBUG_MAC80211(priv, "wait transmit/flush all frames\n");
	iwlagn_wait_tx_queue_empty(priv);
done:
	mutex_unlock(&priv->mutex);
	IWL_DEBUG_MAC80211(priv, "leave\n");
}

2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708
static void iwlagn_disable_roc(struct iwl_priv *priv)
{
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_PAN];
	struct ieee80211_channel *chan = ACCESS_ONCE(priv->hw->conf.channel);

	lockdep_assert_held(&priv->mutex);

	if (!ctx->is_active)
		return;

	ctx->staging.dev_type = RXON_DEV_TYPE_2STA;
	ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
	iwl_set_rxon_channel(priv, chan, ctx);
	iwl_set_flags_for_band(priv, ctx, chan->band, NULL);

W
Wey-Yi Guy 已提交
2709
	priv->hw_roc_channel = NULL;
2710

2711
	iwlagn_commit_rxon(priv, ctx);
2712 2713 2714 2715 2716 2717 2718

	ctx->is_active = false;
}

static void iwlagn_bg_roc_done(struct work_struct *work)
{
	struct iwl_priv *priv = container_of(work, struct iwl_priv,
W
Wey-Yi Guy 已提交
2719
					     hw_roc_work.work);
2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750

	mutex_lock(&priv->mutex);
	ieee80211_remain_on_channel_expired(priv->hw);
	iwlagn_disable_roc(priv);
	mutex_unlock(&priv->mutex);
}

static int iwl_mac_remain_on_channel(struct ieee80211_hw *hw,
				     struct ieee80211_channel *channel,
				     enum nl80211_channel_type channel_type,
				     int duration)
{
	struct iwl_priv *priv = hw->priv;
	int err = 0;

	if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN)))
		return -EOPNOTSUPP;

	if (!(priv->contexts[IWL_RXON_CTX_PAN].interface_modes &
					BIT(NL80211_IFTYPE_P2P_CLIENT)))
		return -EOPNOTSUPP;

	mutex_lock(&priv->mutex);

	if (priv->contexts[IWL_RXON_CTX_PAN].is_active ||
	    test_bit(STATUS_SCAN_HW, &priv->status)) {
		err = -EBUSY;
		goto out;
	}

	priv->contexts[IWL_RXON_CTX_PAN].is_active = true;
W
Wey-Yi Guy 已提交
2751 2752 2753
	priv->hw_roc_channel = channel;
	priv->hw_roc_chantype = channel_type;
	priv->hw_roc_duration = DIV_ROUND_UP(duration * 1000, 1024);
2754
	iwlagn_commit_rxon(priv, &priv->contexts[IWL_RXON_CTX_PAN]);
W
Wey-Yi Guy 已提交
2755
	queue_delayed_work(priv->workqueue, &priv->hw_roc_work,
2756 2757
			   msecs_to_jiffies(duration + 20));

2758
	msleep(IWL_MIN_SLOT_TIME); /* TU is almost ms */
2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773
	ieee80211_ready_on_channel(priv->hw);

 out:
	mutex_unlock(&priv->mutex);

	return err;
}

static int iwl_mac_cancel_remain_on_channel(struct ieee80211_hw *hw)
{
	struct iwl_priv *priv = hw->priv;

	if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN)))
		return -EOPNOTSUPP;

W
Wey-Yi Guy 已提交
2774
	cancel_delayed_work_sync(&priv->hw_roc_work);
2775 2776 2777 2778 2779 2780 2781 2782

	mutex_lock(&priv->mutex);
	iwlagn_disable_roc(priv);
	mutex_unlock(&priv->mutex);

	return 0;
}

Z
Zhu Yi 已提交
2783 2784 2785 2786 2787 2788
/*****************************************************************************
 *
 * driver setup and teardown
 *
 *****************************************************************************/

2789
static void iwl_setup_deferred_work(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2790
{
2791
	priv->workqueue = create_singlethread_workqueue(DRV_NAME);
Z
Zhu Yi 已提交
2792 2793 2794

	init_waitqueue_head(&priv->wait_command_queue);

2795 2796
	INIT_WORK(&priv->restart, iwl_bg_restart);
	INIT_WORK(&priv->beacon_update, iwl_bg_beacon_update);
2797
	INIT_WORK(&priv->run_time_calib_work, iwl_bg_run_time_calib_work);
2798
	INIT_WORK(&priv->tx_flush, iwl_bg_tx_flush);
2799
	INIT_WORK(&priv->bt_full_concurrency, iwl_bg_bt_full_concurrency);
2800
	INIT_WORK(&priv->bt_runtime_config, iwl_bg_bt_runtime_config);
W
Wey-Yi Guy 已提交
2801
	INIT_DELAYED_WORK(&priv->hw_roc_work, iwlagn_bg_roc_done);
2802 2803

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

2805 2806
	if (priv->cfg->lib->bt_setup_deferred_work)
		priv->cfg->lib->bt_setup_deferred_work(priv);
2807 2808 2809

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

2812 2813 2814 2815
	init_timer(&priv->ucode_trace);
	priv->ucode_trace.data = (unsigned long)priv;
	priv->ucode_trace.function = iwl_bg_ucode_trace;

2816 2817 2818
	init_timer(&priv->watchdog);
	priv->watchdog.data = (unsigned long)priv;
	priv->watchdog.function = iwl_bg_watchdog;
Z
Zhu Yi 已提交
2819 2820
}

2821
static void iwl_cancel_deferred_work(struct iwl_priv *priv)
Z
Zhu Yi 已提交
2822
{
2823 2824
	if (priv->cfg->lib->cancel_deferred_work)
		priv->cfg->lib->cancel_deferred_work(priv);
Z
Zhu Yi 已提交
2825

2826
	cancel_work_sync(&priv->run_time_calib_work);
Z
Zhu Yi 已提交
2827
	cancel_work_sync(&priv->beacon_update);
2828 2829 2830

	iwl_cancel_scan_deferred_work(priv);

2831
	cancel_work_sync(&priv->bt_full_concurrency);
2832
	cancel_work_sync(&priv->bt_runtime_config);
2833

2834
	del_timer_sync(&priv->statistics_periodic);
2835
	del_timer_sync(&priv->ucode_trace);
Z
Zhu Yi 已提交
2836 2837
}

2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872
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;

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

	mutex_init(&priv->mutex);

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

	priv->iw_mode = NL80211_IFTYPE_STATION;
J
Johannes Berg 已提交
2873
	priv->current_ht_config.smps = IEEE80211_SMPS_STATIC;
2874
	priv->missed_beacon_threshold = IWL_MISSED_BEACON_THRESHOLD_DEF;
W
Wey-Yi Guy 已提交
2875
	priv->agg_tids_count = 0;
2876

2877 2878 2879 2880 2881
	/* 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;
2882

2883 2884
	priv->rx_statistics_jiffies = jiffies;

2885
	/* Choose which receivers/antennas to use */
W
Wey-Yi Guy 已提交
2886
	iwlagn_set_rxon_chain(priv, &priv->contexts[IWL_RXON_CTX_BSS]);
2887 2888 2889

	iwl_init_scan_params(priv);

2890
	/* init bt coex */
2891 2892
	if (priv->cfg->bt_params &&
	    priv->cfg->bt_params->advanced_bt_coexist) {
W
Wey-Yi Guy 已提交
2893 2894 2895
		priv->kill_ack_mask = IWLAGN_BT_KILL_ACK_MASK_DEFAULT;
		priv->kill_cts_mask = IWLAGN_BT_KILL_CTS_MASK_DEFAULT;
		priv->bt_valid = IWLAGN_BT_ALL_VALID_MSK;
2896 2897 2898 2899 2900
		priv->bt_on_thresh = BT_ON_THRESHOLD_DEF;
		priv->bt_duration = BT_DURATION_LIMIT_DEF;
		priv->dynamic_frag_thresh = BT_FRAG_THRESHOLD_DEF;
	}

2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926
	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);
2927
	kfree(priv->scan_cmd);
2928
	kfree(priv->beacon_cmd);
2929 2930
}

W
Wey-Yi Guy 已提交
2931
static void iwl_mac_rssi_callback(struct ieee80211_hw *hw,
2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953
			   enum ieee80211_rssi_event rssi_event)
{
	struct iwl_priv *priv = hw->priv;

	mutex_lock(&priv->mutex);

	if (priv->cfg->bt_params &&
			priv->cfg->bt_params->advanced_bt_coexist) {
		if (rssi_event == RSSI_EVENT_LOW)
			priv->bt_enable_pspoll = true;
		else if (rssi_event == RSSI_EVENT_HIGH)
			priv->bt_enable_pspoll = false;

		iwlagn_send_advance_bt_config(priv);
	} else {
		IWL_DEBUG_MAC80211(priv, "Advanced BT coex disabled,"
				"ignoring RSSI callback\n");
	}

	mutex_unlock(&priv->mutex);
}

2954
struct ieee80211_ops iwlagn_hw_ops = {
2955 2956 2957
	.tx = iwlagn_mac_tx,
	.start = iwlagn_mac_start,
	.stop = iwlagn_mac_stop,
2958 2959
	.add_interface = iwl_mac_add_interface,
	.remove_interface = iwl_mac_remove_interface,
2960
	.change_interface = iwl_mac_change_interface,
2961
	.config = iwlagn_mac_config,
J
Johannes Berg 已提交
2962
	.configure_filter = iwlagn_configure_filter,
2963 2964
	.set_key = iwlagn_mac_set_key,
	.update_tkip_key = iwlagn_mac_update_tkip_key,
2965
	.conf_tx = iwl_mac_conf_tx,
2966 2967
	.bss_info_changed = iwlagn_bss_info_changed,
	.ampdu_action = iwlagn_mac_ampdu_action,
2968
	.hw_scan = iwl_mac_hw_scan,
2969
	.sta_notify = iwlagn_mac_sta_notify,
2970 2971
	.sta_add = iwlagn_mac_sta_add,
	.sta_remove = iwl_mac_sta_remove,
2972 2973
	.channel_switch = iwlagn_mac_channel_switch,
	.flush = iwlagn_mac_flush,
2974
	.tx_last_beacon = iwl_mac_tx_last_beacon,
2975 2976
	.remain_on_channel = iwl_mac_remain_on_channel,
	.cancel_remain_on_channel = iwl_mac_cancel_remain_on_channel,
J
Johannes Berg 已提交
2977 2978
	.offchannel_tx = iwl_mac_offchannel_tx,
	.offchannel_tx_cancel_wait = iwl_mac_offchannel_tx_cancel_wait,
2979
	.rssi_callback = iwl_mac_rssi_callback,
2980
	CFG80211_TESTMODE_CMD(iwl_testmode_cmd)
2981
	CFG80211_TESTMODE_DUMP(iwl_testmode_dump)
Z
Zhu Yi 已提交
2982 2983
};

J
Johannes Berg 已提交
2984
static u32 iwl_hw_detect(struct iwl_priv *priv)
2985
{
2986
	return iwl_read32(priv, CSR_HW_REV);
2987 2988
}

2989 2990 2991 2992
static int iwl_set_hw_params(struct iwl_priv *priv)
{
	priv->hw_params.max_rxq_size = RX_QUEUE_SIZE;
	priv->hw_params.max_rxq_log = RX_QUEUE_SIZE_LOG;
D
Don Fry 已提交
2993
	if (iwlagn_mod_params.amsdu_size_8K)
2994 2995 2996 2997 2998 2999
		priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_8K);
	else
		priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_4K);

	priv->hw_params.max_beacon_itrvl = IWL_MAX_UCODE_BEACON_INTERVAL;

D
Don Fry 已提交
3000
	if (iwlagn_mod_params.disable_11n)
3001
		priv->cfg->sku &= ~EEPROM_SKU_CAP_11N_ENABLE;
3002 3003

	/* Device-specific setup */
3004
	return priv->cfg->lib->set_hw_params(priv);
3005 3006
}

3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028
static const u8 iwlagn_bss_ac_to_fifo[] = {
	IWL_TX_FIFO_VO,
	IWL_TX_FIFO_VI,
	IWL_TX_FIFO_BE,
	IWL_TX_FIFO_BK,
};

static const u8 iwlagn_bss_ac_to_queue[] = {
	0, 1, 2, 3,
};

static const u8 iwlagn_pan_ac_to_fifo[] = {
	IWL_TX_FIFO_VO_IPAN,
	IWL_TX_FIFO_VI_IPAN,
	IWL_TX_FIFO_BE_IPAN,
	IWL_TX_FIFO_BK_IPAN,
};

static const u8 iwlagn_pan_ac_to_queue[] = {
	7, 6, 5, 4,
};

3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050
/* This function both allocates and initializes hw and priv. */
static struct ieee80211_hw *iwl_alloc_all(struct iwl_cfg *cfg)
{
	struct iwl_priv *priv;
	/* mac80211 allocates memory for this device instance, including
	 *   space for this driver's private structure */
	struct ieee80211_hw *hw;

	hw = ieee80211_alloc_hw(sizeof(struct iwl_priv), &iwlagn_hw_ops);
	if (hw == NULL) {
		pr_err("%s: Can not allocate network device\n",
		       cfg->name);
		goto out;
	}

	priv = hw->priv;
	priv->hw = hw;

out:
	return hw;
}

3051
static void iwl_init_context(struct iwl_priv *priv)
Z
Zhu Yi 已提交
3052
{
3053
	int i;
3054

3055 3056 3057 3058 3059 3060 3061 3062 3063 3064
	/*
	 * The default context is always valid,
	 * more may be discovered when firmware
	 * is loaded.
	 */
	priv->valid_contexts = BIT(IWL_RXON_CTX_BSS);

	for (i = 0; i < NUM_IWL_RXON_CTX; i++)
		priv->contexts[i].ctxid = i;

3065 3066
	priv->contexts[IWL_RXON_CTX_BSS].always_active = true;
	priv->contexts[IWL_RXON_CTX_BSS].is_active = true;
3067 3068 3069
	priv->contexts[IWL_RXON_CTX_BSS].rxon_cmd = REPLY_RXON;
	priv->contexts[IWL_RXON_CTX_BSS].rxon_timing_cmd = REPLY_RXON_TIMING;
	priv->contexts[IWL_RXON_CTX_BSS].rxon_assoc_cmd = REPLY_RXON_ASSOC;
J
Johannes Berg 已提交
3070
	priv->contexts[IWL_RXON_CTX_BSS].qos_cmd = REPLY_QOS_PARAM;
3071
	priv->contexts[IWL_RXON_CTX_BSS].ap_sta_id = IWL_AP_ID;
3072
	priv->contexts[IWL_RXON_CTX_BSS].wep_key_cmd = REPLY_WEPKEY;
3073 3074
	priv->contexts[IWL_RXON_CTX_BSS].ac_to_fifo = iwlagn_bss_ac_to_fifo;
	priv->contexts[IWL_RXON_CTX_BSS].ac_to_queue = iwlagn_bss_ac_to_queue;
3075 3076 3077 3078
	priv->contexts[IWL_RXON_CTX_BSS].exclusive_interface_modes =
		BIT(NL80211_IFTYPE_ADHOC);
	priv->contexts[IWL_RXON_CTX_BSS].interface_modes =
		BIT(NL80211_IFTYPE_STATION);
3079
	priv->contexts[IWL_RXON_CTX_BSS].ap_devtype = RXON_DEV_TYPE_AP;
3080 3081 3082
	priv->contexts[IWL_RXON_CTX_BSS].ibss_devtype = RXON_DEV_TYPE_IBSS;
	priv->contexts[IWL_RXON_CTX_BSS].station_devtype = RXON_DEV_TYPE_ESS;
	priv->contexts[IWL_RXON_CTX_BSS].unused_devtype = RXON_DEV_TYPE_ESS;
J
Johannes Berg 已提交
3083 3084

	priv->contexts[IWL_RXON_CTX_PAN].rxon_cmd = REPLY_WIPAN_RXON;
3085 3086 3087 3088
	priv->contexts[IWL_RXON_CTX_PAN].rxon_timing_cmd =
		REPLY_WIPAN_RXON_TIMING;
	priv->contexts[IWL_RXON_CTX_PAN].rxon_assoc_cmd =
		REPLY_WIPAN_RXON_ASSOC;
J
Johannes Berg 已提交
3089 3090 3091 3092 3093
	priv->contexts[IWL_RXON_CTX_PAN].qos_cmd = REPLY_WIPAN_QOS_PARAM;
	priv->contexts[IWL_RXON_CTX_PAN].ap_sta_id = IWL_AP_ID_PAN;
	priv->contexts[IWL_RXON_CTX_PAN].wep_key_cmd = REPLY_WIPAN_WEPKEY;
	priv->contexts[IWL_RXON_CTX_PAN].bcast_sta_id = IWLAGN_PAN_BCAST_ID;
	priv->contexts[IWL_RXON_CTX_PAN].station_flags = STA_FLG_PAN_STATION;
3094 3095 3096
	priv->contexts[IWL_RXON_CTX_PAN].ac_to_fifo = iwlagn_pan_ac_to_fifo;
	priv->contexts[IWL_RXON_CTX_PAN].ac_to_queue = iwlagn_pan_ac_to_queue;
	priv->contexts[IWL_RXON_CTX_PAN].mcast_queue = IWL_IPAN_MCAST_QUEUE;
3097 3098
	priv->contexts[IWL_RXON_CTX_PAN].interface_modes =
		BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_AP);
W
Wey-Yi Guy 已提交
3099 3100 3101 3102
#ifdef CONFIG_IWL_P2P
	priv->contexts[IWL_RXON_CTX_PAN].interface_modes |=
		BIT(NL80211_IFTYPE_P2P_CLIENT) | BIT(NL80211_IFTYPE_P2P_GO);
#endif
3103 3104 3105
	priv->contexts[IWL_RXON_CTX_PAN].ap_devtype = RXON_DEV_TYPE_CP;
	priv->contexts[IWL_RXON_CTX_PAN].station_devtype = RXON_DEV_TYPE_2STA;
	priv->contexts[IWL_RXON_CTX_PAN].unused_devtype = RXON_DEV_TYPE_P2P;
J
Johannes Berg 已提交
3106 3107

	BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);
3108 3109
}

3110
int iwl_probe(struct iwl_bus *bus, struct iwl_cfg *cfg)
3111 3112 3113 3114
{
	int err = 0;
	struct iwl_priv *priv;
	struct ieee80211_hw *hw;
3115
	u16 num_mac;
3116 3117 3118 3119 3120 3121 3122 3123
	u32 hw_rev;

	/************************
	 * 1. Allocating HW data
	 ************************/
	hw = iwl_alloc_all(cfg);
	if (!hw) {
		err = -ENOMEM;
3124 3125 3126
		goto out;
	}

3127
	priv = hw->priv;
3128 3129
	priv->bus = bus;
	bus_set_drv_data(priv->bus, priv);
3130

3131
	/* At this point both hw and priv are allocated. */
3132

3133
	SET_IEEE80211_DEV(hw, priv->bus->dev);
Z
Zhu Yi 已提交
3134

3135
	IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
T
Tomas Winkler 已提交
3136
	priv->cfg = cfg;
3137
	priv->inta_mask = CSR_INI_SET_MASK;
3138

3139
	err = iwl_trans_register(&priv->trans, priv);
3140 3141 3142
	if (err)
		goto out_free_priv;

3143 3144 3145 3146 3147
	/* is antenna coupling more than 35dB ? */
	priv->bt_ant_couple_ok =
		(iwlagn_ant_coupling > IWL_BT_ANTENNA_COUPLING_THRESHOLD) ?
		true : false;

3148
	/* enable/disable bt channel inhibition */
3149
	priv->bt_ch_announce = iwlagn_bt_ch_announce;
3150 3151
	IWL_DEBUG_INFO(priv, "BT channel inhibition is %s\n",
		       (priv->bt_ch_announce) ? "On" : "Off");
3152

3153 3154
	if (iwl_alloc_traffic_mem(priv))
		IWL_ERR(priv, "Not enough memory to generate traffic log\n");
Z
Zhu Yi 已提交
3155

3156
	/* these spin locks will be used in apm_ops.init and EEPROM access
M
Mohamed Abbas 已提交
3157 3158 3159
	 * we should init now
	 */
	spin_lock_init(&priv->reg_lock);
3160
	spin_lock_init(&priv->lock);
3161 3162 3163 3164 3165 3166 3167 3168

	/*
	 * 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);

3169 3170 3171
	/***********************
	 * 3. Read REV register
	 ***********************/
J
Johannes Berg 已提交
3172
	hw_rev = iwl_hw_detect(priv);
3173
	IWL_INFO(priv, "Detected %s, REV=0x%X\n",
J
Johannes Berg 已提交
3174
		priv->cfg->name, hw_rev);
3175

3176
	if (trans_prepare_card_hw(&priv->trans)) {
3177
		err = -EIO;
M
Mohamed Abbas 已提交
3178
		IWL_WARN(priv, "Failed, HW not ready\n");
3179
		goto out_free_traffic_mem;
M
Mohamed Abbas 已提交
3180 3181
	}

T
Tomas Winkler 已提交
3182 3183 3184
	/*****************
	 * 4. Read EEPROM
	 *****************/
3185
	/* Read the EEPROM */
J
Johannes Berg 已提交
3186
	err = iwl_eeprom_init(priv, hw_rev);
3187
	if (err) {
3188
		IWL_ERR(priv, "Unable to init EEPROM\n");
3189
		goto out_free_traffic_mem;
3190
	}
3191 3192
	err = iwl_eeprom_check_version(priv);
	if (err)
3193
		goto out_free_eeprom;
3194

3195 3196 3197 3198
	err = iwl_eeprom_check_sku(priv);
	if (err)
		goto out_free_eeprom;

3199
	/* extract MAC Address */
3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210
	iwl_eeprom_get_mac(priv, priv->addresses[0].addr);
	IWL_DEBUG_INFO(priv, "MAC address: %pM\n", priv->addresses[0].addr);
	priv->hw->wiphy->addresses = priv->addresses;
	priv->hw->wiphy->n_addresses = 1;
	num_mac = iwl_eeprom_query16(priv, EEPROM_NUM_MAC_ADDRESS);
	if (num_mac > 1) {
		memcpy(priv->addresses[1].addr, priv->addresses[0].addr,
		       ETH_ALEN);
		priv->addresses[1].addr[5]++;
		priv->hw->wiphy->n_addresses++;
	}
3211

3212 3213 3214
	/* initialize all valid contexts */
	iwl_init_context(priv);

3215 3216 3217
	/************************
	 * 5. Setup HW constants
	 ************************/
3218
	if (iwl_set_hw_params(priv)) {
3219
		err = -ENOENT;
3220
		IWL_ERR(priv, "failed to set hw parameters\n");
3221
		goto out_free_eeprom;
3222 3223 3224
	}

	/*******************
T
Tomas Winkler 已提交
3225
	 * 6. Setup priv
3226
	 *******************/
Z
Zhu Yi 已提交
3227

T
Tomas Winkler 已提交
3228
	err = iwl_init_drv(priv);
3229
	if (err)
R
Ron Rindjunsky 已提交
3230
		goto out_free_eeprom;
3231
	/* At this point both hw and priv are initialized. */
3232 3233

	/********************
3234
	 * 7. Setup services
3235
	 ********************/
3236
	iwl_setup_deferred_work(priv);
3237
	iwl_setup_rx_handlers(priv);
3238
	iwl_testmode_init(priv);
3239

J
Johannes Berg 已提交
3240
	/*********************************************
3241
	 * 8. Enable interrupts
J
Johannes Berg 已提交
3242
	 *********************************************/
T
Tomas Winkler 已提交
3243

3244
	iwl_enable_rfkill_int(priv);
3245 3246 3247 3248 3249 3250

	/* 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 已提交
3251

J
Johannes Berg 已提交
3252 3253
	wiphy_rfkill_set_hw_state(priv->hw->wiphy,
		test_bit(STATUS_RF_KILL_HW, &priv->status));
3254

3255
	iwl_power_initialize(priv);
3256
	iwl_tt_initialize(priv);
J
Johannes Berg 已提交
3257

W
Wey-Yi Guy 已提交
3258
	init_completion(&priv->firmware_loading_complete);
3259

3260
	err = iwl_request_firmware(priv, true);
J
Johannes Berg 已提交
3261
	if (err)
3262
		goto out_destroy_workqueue;
J
Johannes Berg 已提交
3263

Z
Zhu Yi 已提交
3264 3265
	return 0;

3266
out_destroy_workqueue:
3267 3268
	destroy_workqueue(priv->workqueue);
	priv->workqueue = NULL;
T
Tomas Winkler 已提交
3269
	iwl_uninit_drv(priv);
3270
out_free_eeprom:
3271
	iwl_eeprom_free(priv);
3272
out_free_traffic_mem:
3273
	iwl_free_traffic_mem(priv);
3274
	trans_free(&priv->trans);
3275
out_free_priv:
3276
	ieee80211_free_hw(priv->hw);
3277
out:
Z
Zhu Yi 已提交
3278 3279 3280
	return err;
}

3281
void __devexit iwl_remove(struct iwl_priv * priv)
Z
Zhu Yi 已提交
3282
{
3283
	unsigned long flags;
Z
Zhu Yi 已提交
3284

W
Wey-Yi Guy 已提交
3285
	wait_for_completion(&priv->firmware_loading_complete);
3286

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

3289
	iwl_dbgfs_unregister(priv);
3290
	sysfs_remove_group(&priv->bus->dev->kobj,
3291
			   &iwl_attribute_group);
3292

3293 3294
	/* ieee80211_unregister_hw call wil cause iwl_mac_stop to
	 * to be called and iwl_down since we are removing the device
3295 3296 3297
	 * we need to set STATUS_EXIT_PENDING bit.
	 */
	set_bit(STATUS_EXIT_PENDING, &priv->status);
3298

W
Wey-Yi Guy 已提交
3299
	iwl_testmode_cleanup(priv);
3300 3301
	iwl_leds_exit(priv);

3302 3303 3304 3305 3306
	if (priv->mac80211_registered) {
		ieee80211_unregister_hw(priv->hw);
		priv->mac80211_registered = 0;
	}

J
Johannes Berg 已提交
3307
	/* Reset to low power before unloading driver. */
J
Johannes Berg 已提交
3308
	iwl_apm_stop(priv);
3309

3310 3311
	iwl_tt_exit(priv);

3312 3313 3314 3315
	/* make sure we flush any pending irq or
	 * tasklet for the driver
	 */
	spin_lock_irqsave(&priv->lock, flags);
3316
	iwl_disable_interrupts(priv);
3317 3318
	spin_unlock_irqrestore(&priv->lock, flags);

3319
	trans_sync_irq(&priv->trans);
3320

3321
	iwl_dealloc_ucode(priv);
Z
Zhu Yi 已提交
3322

3323 3324
	trans_rx_free(&priv->trans);
	trans_tx_free(&priv->trans);
Z
Zhu Yi 已提交
3325

3326
	iwl_eeprom_free(priv);
Z
Zhu Yi 已提交
3327

M
Mohamed Abbas 已提交
3328 3329 3330
	/*netif_stop_queue(dev); */
	flush_workqueue(priv->workqueue);

3331
	/* ieee80211_unregister_hw calls iwl_mac_stop, which flushes
Z
Zhu Yi 已提交
3332 3333 3334 3335
	 * priv->workqueue... so we can't take down the workqueue
	 * until now... */
	destroy_workqueue(priv->workqueue);
	priv->workqueue = NULL;
3336
	iwl_free_traffic_mem(priv);
Z
Zhu Yi 已提交
3337

3338
	trans_free(&priv->trans);
3339

3340
	bus_set_drv_data(priv->bus, NULL);
Z
Zhu Yi 已提交
3341

T
Tomas Winkler 已提交
3342
	iwl_uninit_drv(priv);
Z
Zhu Yi 已提交
3343

3344
	dev_kfree_skb(priv->beacon_skb);
Z
Zhu Yi 已提交
3345 3346 3347 3348 3349 3350 3351 3352 3353 3354

	ieee80211_free_hw(priv->hw);
}


/*****************************************************************************
 *
 * driver and module entry point
 *
 *****************************************************************************/
3355
static int __init iwl_init(void)
Z
Zhu Yi 已提交
3356 3357 3358
{

	int ret;
3359 3360
	pr_info(DRV_DESCRIPTION ", " DRV_VERSION "\n");
	pr_info(DRV_COPYRIGHT "\n");
3361

3362
	ret = iwlagn_rate_control_register();
3363
	if (ret) {
3364
		pr_err("Unable to register rate control algorithm: %d\n", ret);
3365 3366 3367
		return ret;
	}

3368
	ret = iwl_pci_register_driver();
Z
Zhu Yi 已提交
3369

3370 3371
	if (ret)
		goto error_register;
Z
Zhu Yi 已提交
3372
	return ret;
3373 3374

error_register:
3375
	iwlagn_rate_control_unregister();
3376
	return ret;
Z
Zhu Yi 已提交
3377 3378
}

3379
static void __exit iwl_exit(void)
Z
Zhu Yi 已提交
3380
{
3381
	iwl_pci_unregister_driver();
3382
	iwlagn_rate_control_unregister();
Z
Zhu Yi 已提交
3383 3384
}

3385 3386
module_exit(iwl_exit);
module_init(iwl_init);
3387 3388

#ifdef CONFIG_IWLWIFI_DEBUG
3389
module_param_named(debug, iwl_debug_level, uint, S_IRUGO | S_IWUSR);
3390 3391 3392
MODULE_PARM_DESC(debug, "debug output mask");
#endif

3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403
module_param_named(swcrypto, iwlagn_mod_params.sw_crypto, int, S_IRUGO);
MODULE_PARM_DESC(swcrypto, "using crypto in software (default 0 [hardware])");
module_param_named(queues_num, iwlagn_mod_params.num_of_queues, int, S_IRUGO);
MODULE_PARM_DESC(queues_num, "number of hw queues.");
module_param_named(11n_disable, iwlagn_mod_params.disable_11n, int, S_IRUGO);
MODULE_PARM_DESC(11n_disable, "disable 11n functionality");
module_param_named(amsdu_size_8K, iwlagn_mod_params.amsdu_size_8K,
		   int, S_IRUGO);
MODULE_PARM_DESC(amsdu_size_8K, "enable 8K amsdu size");
module_param_named(fw_restart, iwlagn_mod_params.restart_fw, int, S_IRUGO);
MODULE_PARM_DESC(fw_restart, "restart firmware in case of error");
3404 3405 3406 3407 3408

module_param_named(ucode_alternative, iwlagn_wanted_ucode_alternative, int,
		   S_IRUGO);
MODULE_PARM_DESC(ucode_alternative,
		 "specify ucode alternative to use from ucode file");
3409 3410 3411 3412

module_param_named(antenna_coupling, iwlagn_ant_coupling, int, S_IRUGO);
MODULE_PARM_DESC(antenna_coupling,
		 "specify antenna coupling in dB (defualt: 0 dB)");
3413

3414 3415 3416
module_param_named(bt_ch_inhibition, iwlagn_bt_ch_announce, bool, S_IRUGO);
MODULE_PARM_DESC(bt_ch_inhibition,
		 "Disable BT channel inhibition (default: enable)");
3417 3418 3419 3420 3421 3422

module_param_named(plcp_check, iwlagn_mod_params.plcp_check, bool, S_IRUGO);
MODULE_PARM_DESC(plcp_check, "Check plcp health (default: 1 [enabled])");

module_param_named(ack_check, iwlagn_mod_params.ack_check, bool, S_IRUGO);
MODULE_PARM_DESC(ack_check, "Check ack health (default: 0 [disabled])");
3423

3424 3425 3426 3427
module_param_named(wd_disable, iwlagn_mod_params.wd_disable, bool, S_IRUGO);
MODULE_PARM_DESC(wd_disable,
		"Disable stuck queue watchdog timer (default: 0 [enabled])");

3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446
/*
 * set bt_coex_active to true, uCode will do kill/defer
 * every time the priority line is asserted (BT is sending signals on the
 * priority line in the PCIx).
 * set bt_coex_active to false, uCode will ignore the BT activity and
 * perform the normal operation
 *
 * User might experience transmit issue on some platform due to WiFi/BT
 * co-exist problem. The possible behaviors are:
 *   Able to scan and finding all the available AP
 *   Not able to associate with any AP
 * On those platforms, WiFi communication can be restored by set
 * "bt_coex_active" module parameter to "false"
 *
 * default: bt_coex_active = true (BT_COEX_ENABLE)
 */
module_param_named(bt_coex_active, iwlagn_mod_params.bt_coex_active,
		bool, S_IRUGO);
MODULE_PARM_DESC(bt_coex_active, "enable wifi/bt co-exist (default: enable)");
3447 3448 3449 3450

module_param_named(led_mode, iwlagn_mod_params.led_mode, int, S_IRUGO);
MODULE_PARM_DESC(led_mode, "0=system default, "
		"1=On(RF On)/Off(RF Off), 2=blinking (default: 0)");
3451

3452 3453 3454 3455 3456
module_param_named(power_save, iwlagn_mod_params.power_save,
		bool, S_IRUGO);
MODULE_PARM_DESC(power_save,
		 "enable WiFi power management (default: disable)");

3457 3458 3459 3460 3461
module_param_named(power_level, iwlagn_mod_params.power_level,
		int, S_IRUGO);
MODULE_PARM_DESC(power_level,
		 "default power save level (range from 1 - 5, default: 1)");

3462 3463 3464 3465 3466 3467 3468 3469 3470
/*
 * For now, keep using power level 1 instead of automatically
 * adjusting ...
 */
module_param_named(no_sleep_autoadjust, iwlagn_mod_params.no_sleep_autoadjust,
		bool, S_IRUGO);
MODULE_PARM_DESC(no_sleep_autoadjust,
		 "don't automatically adjust sleep level "
		 "according to maximum network latency (default: true)");