iwl-agn.c 58.4 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
#include <linux/delay.h>
34
#include <linux/sched.h>
Z
Zhu Yi 已提交
35 36 37 38 39 40 41 42 43 44
#include <linux/skbuff.h>
#include <linux/netdevice.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 已提交
45
#include "iwl-eeprom.h"
46
#include "iwl-dev.h"
47
#include "iwl-core.h"
48
#include "iwl-io.h"
J
Johannes Berg 已提交
49
#include "iwl-agn-calib.h"
50
#include "iwl-agn.h"
51
#include "iwl-shared.h"
52
#include "iwl-bus.h"
53
#include "iwl-trans.h"
54

Z
Zhu Yi 已提交
55 56 57 58 59 60 61 62 63
/******************************************************************************
 *
 * module boiler plate
 *
 ******************************************************************************/

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

66
#ifdef CONFIG_IWLWIFI_DEBUG
Z
Zhu Yi 已提交
67 68 69 70 71
#define VD "d"
#else
#define VD
#endif

72
#define DRV_VERSION     IWLWIFI_VERSION VD
Z
Zhu Yi 已提交
73 74 75 76


MODULE_DESCRIPTION(DRV_DESCRIPTION);
MODULE_VERSION(DRV_VERSION);
77
MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
Z
Zhu Yi 已提交
78
MODULE_LICENSE("GPL");
79
MODULE_ALIAS("iwlagn");
Z
Zhu Yi 已提交
80

81
void iwl_update_chain_flags(struct iwl_priv *priv)
M
Mohamed Abbas 已提交
82
{
83
	struct iwl_rxon_context *ctx;
M
Mohamed Abbas 已提交
84

W
Wey-Yi Guy 已提交
85 86 87 88
	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);
89
	}
M
Mohamed Abbas 已提交
90 91
}

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

119
int iwlagn_send_beacon_cmd(struct iwl_priv *priv)
120 121
{
	struct iwl_tx_beacon_cmd *tx_beacon_cmd;
122 123
	struct iwl_host_cmd cmd = {
		.id = REPLY_TX_BEACON,
124
		.flags = CMD_SYNC,
125
	};
126
	struct ieee80211_tx_info *info;
127 128 129
	u32 frame_size;
	u32 rate_flags;
	u32 rate;
130

131 132 133 134
	/*
	 * We have to set up the TX command, the TX Beacon command, and the
	 * beacon contents.
	 */
135

136
	lockdep_assert_held(&priv->shrd->mutex);
137 138 139

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

143 144 145
	if (WARN_ON(!priv->beacon_skb))
		return -EINVAL;

146 147 148 149
	/* Allocate beacon command */
	if (!priv->beacon_cmd)
		priv->beacon_cmd = kzalloc(sizeof(*tx_beacon_cmd), GFP_KERNEL);
	tx_beacon_cmd = priv->beacon_cmd;
150 151 152 153
	if (!tx_beacon_cmd)
		return -ENOMEM;

	frame_size = priv->beacon_skb->len;
154

155
	/* Set up TX command fields */
156
	tx_beacon_cmd->tx.len = cpu_to_le16((u16)frame_size);
157
	tx_beacon_cmd->tx.sta_id = priv->beacon_ctx->bcast_sta_id;
158 159 160
	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;
161

162
	/* Set up TX beacon command fields */
163
	iwl_set_beacon_tim(priv, tx_beacon_cmd, priv->beacon_skb->data,
164
			   frame_size);
165

166
	/* Set up packet rate and flags */
167 168 169 170 171 172 173 174 175 176 177 178 179
	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;

180
	priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant,
181
					      hw_params(priv).valid_tx_ant);
182
	rate_flags = iwl_ant_idx_to_flags(priv->mgmt_tx_ant);
183 184 185 186 187

	/* 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)
188
		rate_flags |= RATE_MCS_CCK_MSK;
189 190 191

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

193
	/* Submit command */
194
	cmd.len[0] = sizeof(*tx_beacon_cmd);
195
	cmd.data[0] = tx_beacon_cmd;
196 197 198 199
	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;
200

201
	return iwl_trans_send_cmd(trans(priv), &cmd);
202 203
}

204
static void iwl_bg_beacon_update(struct work_struct *work)
Z
Zhu Yi 已提交
205
{
206 207
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, beacon_update);
Z
Zhu Yi 已提交
208 209
	struct sk_buff *beacon;

210
	mutex_lock(&priv->shrd->mutex);
211 212 213 214
	if (!priv->beacon_ctx) {
		IWL_ERR(priv, "updating beacon w/o beacon context!\n");
		goto out;
	}
Z
Zhu Yi 已提交
215

216 217 218 219 220 221 222 223 224 225
	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;
	}

226 227
	/* 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 已提交
228
	if (!beacon) {
229
		IWL_ERR(priv, "update beacon failed -- keeping old\n");
230
		goto out;
Z
Zhu Yi 已提交
231 232 233
	}

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

236
	priv->beacon_skb = beacon;
Z
Zhu Yi 已提交
237

238
	iwlagn_send_beacon_cmd(priv);
239
 out:
240
	mutex_unlock(&priv->shrd->mutex);
Z
Zhu Yi 已提交
241 242
}

243 244 245 246 247
static void iwl_bg_bt_runtime_config(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, bt_runtime_config);

248
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
249 250 251
		return;

	/* dont send host command if rf-kill is on */
252
	if (!iwl_is_ready_rf(priv->shrd))
253
		return;
W
Wey-Yi Guy 已提交
254
	iwlagn_send_advance_bt_config(priv);
255 256
}

257 258 259 260
static void iwl_bg_bt_full_concurrency(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, bt_full_concurrency);
261
	struct iwl_rxon_context *ctx;
262

263
	mutex_lock(&priv->shrd->mutex);
264

265
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
266
		goto out;
267 268

	/* dont send host command if rf-kill is on */
269
	if (!iwl_is_ready_rf(priv->shrd))
270
		goto out;
271 272 273 274 275 276 277 278 279

	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
	 */
280
	for_each_context(priv, ctx) {
W
Wey-Yi Guy 已提交
281
		iwlagn_set_rxon_chain(priv, ctx);
282
		iwlagn_commit_rxon(priv, ctx);
283
	}
284

W
Wey-Yi Guy 已提交
285
	iwlagn_send_advance_bt_config(priv);
286
out:
287
	mutex_unlock(&priv->shrd->mutex);
288 289
}

290
/**
291
 * iwl_bg_statistics_periodic - Timer callback to queue statistics
292 293 294 295 296 297 298 299
 *
 * 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.
 */
300
static void iwl_bg_statistics_periodic(unsigned long data)
301 302 303
{
	struct iwl_priv *priv = (struct iwl_priv *)data;

304
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
305 306
		return;

307
	/* dont send host command if rf-kill is on */
308
	if (!iwl_is_ready_rf(priv->shrd))
309 310
		return;

311
	iwl_send_statistics_request(priv, CMD_ASYNC, false);
312 313
}

314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329

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 */
330 331 332
	spin_lock_irqsave(&bus(priv)->reg_lock, reg_flags);
	if (iwl_grab_nic_access(bus(priv))) {
		spin_unlock_irqrestore(&bus(priv)->reg_lock, reg_flags);
333 334 335 336
		return;
	}

	/* Set starting address; reads will auto-increment */
337
	iwl_write32(bus(priv), HBUS_TARG_MEM_RADDR, ptr);
338 339 340 341 342 343 344
	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++) {
345 346
		ev = iwl_read32(bus(priv), HBUS_TARG_MEM_RDAT);
		time = iwl_read32(bus(priv), HBUS_TARG_MEM_RDAT);
347 348 349 350
		if (mode == 0) {
			trace_iwlwifi_dev_ucode_cont_event(priv,
							0, time, ev);
		} else {
351
			data = iwl_read32(bus(priv), HBUS_TARG_MEM_RDAT);
352 353 354 355 356
			trace_iwlwifi_dev_ucode_cont_event(priv,
						time, data, ev);
		}
	}
	/* Allow device to power down */
357 358
	iwl_release_nic_access(bus(priv));
	spin_unlock_irqrestore(&bus(priv)->reg_lock, reg_flags);
359 360
}

J
Johannes Berg 已提交
361
static void iwl_continuous_event_trace(struct iwl_priv *priv)
362 363 364 365 366 367 368
{
	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 */

369
	base = priv->shrd->device_pointers.error_event_table;
370
	if (iwlagn_hw_valid_rtc_data_addr(base)) {
371 372 373 374 375 376
		capacity = iwl_read_targ_mem(bus(priv), base);
		num_wraps = iwl_read_targ_mem(bus(priv),
						base + (2 * sizeof(u32)));
		mode = iwl_read_targ_mem(bus(priv), base + (1 * sizeof(u32)));
		next_entry = iwl_read_targ_mem(bus(priv),
						base + (3 * sizeof(u32)));
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
	} 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;

427
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
428 429 430 431 432 433 434 435 436 437
		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));
	}
}

438 439 440 441 442
static void iwl_bg_tx_flush(struct work_struct *work)
{
	struct iwl_priv *priv =
		container_of(work, struct iwl_priv, tx_flush);

443
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
444 445 446
		return;

	/* do nothing if rf-kill is on */
447
	if (!iwl_is_ready_rf(priv->shrd))
448 449
		return;

450 451
	IWL_DEBUG_INFO(priv, "device request: flush all tx frames\n");
	iwlagn_dev_txfifo_flush(priv, IWL_DROP_ALL);
452 453
}

454 455 456 457 458 459 460 461
static void iwl_init_context(struct iwl_priv *priv, u32 ucode_flags)
{
	int i;

	/*
	 * The default context is always valid,
	 * the PAN context depends on uCode.
	 */
462
	priv->shrd->valid_contexts = BIT(IWL_RXON_CTX_BSS);
463
	if (ucode_flags & IWL_UCODE_TLV_FLAGS_PAN)
464
		priv->shrd->valid_contexts |= BIT(IWL_RXON_CTX_PAN);
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

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

	priv->contexts[IWL_RXON_CTX_BSS].always_active = true;
	priv->contexts[IWL_RXON_CTX_BSS].is_active = true;
	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;
	priv->contexts[IWL_RXON_CTX_BSS].qos_cmd = REPLY_QOS_PARAM;
	priv->contexts[IWL_RXON_CTX_BSS].ap_sta_id = IWL_AP_ID;
	priv->contexts[IWL_RXON_CTX_BSS].wep_key_cmd = REPLY_WEPKEY;
	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);
	priv->contexts[IWL_RXON_CTX_BSS].ap_devtype = RXON_DEV_TYPE_AP;
	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;

	priv->contexts[IWL_RXON_CTX_PAN].rxon_cmd = REPLY_WIPAN_RXON;
	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;
	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;
	priv->contexts[IWL_RXON_CTX_PAN].interface_modes =
		BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_AP);
498 499 500 501 502 503

	if (ucode_flags & IWL_UCODE_TLV_FLAGS_P2P)
		priv->contexts[IWL_RXON_CTX_PAN].interface_modes |=
			BIT(NL80211_IFTYPE_P2P_CLIENT) |
			BIT(NL80211_IFTYPE_P2P_GO);

504 505 506 507 508 509 510
	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;

	BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);
}

511 512
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context);

513 514 515
#define UCODE_EXPERIMENTAL_INDEX	100
#define UCODE_EXPERIMENTAL_TAG		"exp"

516 517
static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
{
518
	const char *name_pre = cfg(priv)->fw_name_pre;
519
	char tag[8];
520

521 522 523 524 525 526
	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
527
		priv->fw_index = cfg(priv)->ucode_api_max;
528 529
		sprintf(tag, "%d", priv->fw_index);
	} else {
530
		priv->fw_index--;
531 532
		sprintf(tag, "%d", priv->fw_index);
	}
533

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

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

541 542 543
	IWL_DEBUG_INFO(priv, "attempting to load firmware %s'%s'\n",
		       (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
				? "EXPERIMENTAL " : "",
544 545 546
		       priv->firmware_name);

	return request_firmware_nowait(THIS_MODULE, 1, priv->firmware_name,
547
				       bus(priv)->dev,
548
				       GFP_KERNEL, priv, iwl_ucode_callback);
549 550
}

551
struct iwlagn_firmware_pieces {
J
Johannes Berg 已提交
552 553 554
	const void *inst, *data, *init, *init_data, *wowlan_inst, *wowlan_data;
	size_t inst_size, data_size, init_size, init_data_size,
	       wowlan_inst_size, wowlan_data_size;
555 556

	u32 build;
557 558 559

	u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
	u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
560 561 562 563 564 565 566 567 568 569 570 571 572 573 574
};

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:
575 576 577 578
		hdr_size = 28;
		if (ucode_raw->size < hdr_size) {
			IWL_ERR(priv, "File size too small!\n");
			return -EINVAL;
579
		}
580 581 582 583 584 585 586
		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;
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606
	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 已提交
607
				pieces->init_data_size) {
608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626

		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;
}

627 628 629 630 631 632 633 634 635
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;
636 637
	int wanted_alternative = iwlagn_mod_params.wanted_ucode_alternative;
	int tmp;
638
	u64 alternatives;
639 640 641
	u32 tlv_len;
	enum iwl_ucode_tlv_type tlv_type;
	const u8 *tlv_data;
642

643 644
	if (len < sizeof(*ucode)) {
		IWL_ERR(priv, "uCode has invalid length: %zd\n", len);
645
		return -EINVAL;
646
	}
647

648 649 650
	if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
		IWL_ERR(priv, "invalid uCode magic: 0X%x\n",
			le32_to_cpu(ucode->magic));
651
		return -EINVAL;
652
	}
653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676

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

677
	while (len >= sizeof(*tlv)) {
678 679 680 681 682 683 684 685 686 687
		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;

688 689 690
		if (len < tlv_len) {
			IWL_ERR(priv, "invalid TLV len: %zd/%u\n",
				len, tlv_len);
691
			return -EINVAL;
692
		}
693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721
		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 已提交
722
			IWL_ERR(priv, "Found unexpected BOOT ucode\n");
723 724
			break;
		case IWL_UCODE_TLV_PROBE_MAX_LEN:
725 726 727
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			capa->max_probe_length =
728
					le32_to_cpup((__le32 *)tlv_data);
729
			break;
J
Johannes Berg 已提交
730 731 732
		case IWL_UCODE_TLV_PAN:
			if (tlv_len)
				goto invalid_tlv_len;
J
Johannes Berg 已提交
733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749
			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 已提交
750
			break;
751
		case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
752 753 754
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_evtlog_ptr =
755
					le32_to_cpup((__le32 *)tlv_data);
756 757
			break;
		case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
758 759 760
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_evtlog_size =
761
					le32_to_cpup((__le32 *)tlv_data);
762 763
			break;
		case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
764 765 766
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->init_errlog_ptr =
767
					le32_to_cpup((__le32 *)tlv_data);
768 769
			break;
		case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
770 771 772
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_evtlog_ptr =
773
					le32_to_cpup((__le32 *)tlv_data);
774 775
			break;
		case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
776 777 778
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_evtlog_size =
779
					le32_to_cpup((__le32 *)tlv_data);
780 781
			break;
		case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
782 783 784
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			pieces->inst_errlog_ptr =
785
					le32_to_cpup((__le32 *)tlv_data);
786
			break;
787 788
		case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
			if (tlv_len)
789 790
				goto invalid_tlv_len;
			priv->enhance_sensitivity_table = true;
791
			break;
J
Johannes Berg 已提交
792 793 794 795 796 797 798 799
		case IWL_UCODE_TLV_WOWLAN_INST:
			pieces->wowlan_inst = tlv_data;
			pieces->wowlan_inst_size = tlv_len;
			break;
		case IWL_UCODE_TLV_WOWLAN_DATA:
			pieces->wowlan_data = tlv_data;
			pieces->wowlan_data_size = tlv_len;
			break;
800
		case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
801 802 803
			if (tlv_len != sizeof(u32))
				goto invalid_tlv_len;
			capa->standard_phy_calibration_size =
804 805
					le32_to_cpup((__le32 *)tlv_data);
			break;
806
		default:
807
			IWL_DEBUG_INFO(priv, "unknown TLV: %d\n", tlv_type);
808 809 810 811
			break;
		}
	}

812 813 814
	if (len) {
		IWL_ERR(priv, "invalid TLV after parsing: %zd\n", len);
		iwl_print_hex_dump(priv, IWL_DL_FW, (u8 *)data, len);
815
		return -EINVAL;
816
	}
817

818 819 820 821 822 823 824
	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;
825 826
}

Z
Zhu Yi 已提交
827
/**
828
 * iwl_ucode_callback - callback when firmware was loaded
Z
Zhu Yi 已提交
829
 *
830 831
 * If loaded successfully, copies the firmware into buffers
 * for the card to fetch (via DMA).
Z
Zhu Yi 已提交
832
 */
833
static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context)
Z
Zhu Yi 已提交
834
{
835
	struct iwl_priv *priv = context;
836
	struct iwl_ucode_header *ucode;
837 838
	int err;
	struct iwlagn_firmware_pieces pieces;
839 840 841
	const unsigned int api_max = cfg(priv)->ucode_api_max;
	unsigned int api_ok = cfg(priv)->ucode_api_ok;
	const unsigned int api_min = cfg(priv)->ucode_api_min;
842
	u32 api_ver;
843
	char buildstr[25];
844
	u32 build;
845 846
	struct iwlagn_ucode_capabilities ucode_capa = {
		.max_probe_length = 200,
847
		.standard_phy_calibration_size =
848
			IWL_DEFAULT_STANDARD_PHY_CALIBRATE_TBL_SIZE,
849
	};
850

851 852 853
	if (!api_ok)
		api_ok = api_max;

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

856
	if (!ucode_raw) {
857
		if (priv->fw_index <= api_ok)
858 859 860
			IWL_ERR(priv,
				"request for firmware file '%s' failed.\n",
				priv->firmware_name);
861
		goto try_again;
Z
Zhu Yi 已提交
862 863
	}

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

867 868
	/* Make sure that we got at least the API version number */
	if (ucode_raw->size < 4) {
869
		IWL_ERR(priv, "File size way too small!\n");
870
		goto try_again;
Z
Zhu Yi 已提交
871 872 873
	}

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

876 877 878
	if (ucode->ver)
		err = iwlagn_load_legacy_firmware(priv, ucode_raw, &pieces);
	else
879 880
		err = iwlagn_load_firmware(priv, ucode_raw, &pieces,
					   &ucode_capa);
881

882 883
	if (err)
		goto try_again;
Z
Zhu Yi 已提交
884

885
	api_ver = IWL_UCODE_API(priv->ucode_ver);
886
	build = pieces.build;
887

888 889 890 891 892
	/*
	 * 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
	 */
893 894 895 896 897 898 899 900 901
	/* 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;
		}
902

903 904 905 906 907 908 909 910 911 912 913 914
		if (api_ver < api_ok) {
			if (api_ok != api_max)
				IWL_ERR(priv, "Firmware has old API version, "
					"expected v%u through v%u, got v%u.\n",
					api_ok, api_max, api_ver);
			else
				IWL_ERR(priv, "Firmware has old API version, "
					"expected v%u, got v%u.\n",
					api_max, api_ver);
			IWL_ERR(priv, "New firmware can be obtained from "
				      "http://www.intellinuxwireless.org/.\n");
		}
915
	}
916

917
	if (build)
918 919 920
		sprintf(buildstr, " build %u%s", build,
		       (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
				? " (EXP)" : "");
921 922 923 924 925 926 927 928 929
	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);
930

931 932
	snprintf(priv->hw->wiphy->fw_version,
		 sizeof(priv->hw->wiphy->fw_version),
933
		 "%u.%u.%u.%u%s",
934 935 936
		 IWL_UCODE_MAJOR(priv->ucode_ver),
		 IWL_UCODE_MINOR(priv->ucode_ver),
		 IWL_UCODE_API(priv->ucode_ver),
937 938
		 IWL_UCODE_SERIAL(priv->ucode_ver),
		 buildstr);
Z
Zhu Yi 已提交
939

940 941 942 943 944 945
	/*
	 * 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.
	 */

946 947 948 949 950 951 952 953 954 955
	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 已提交
956 957

	/* Verify that uCode images will fit in card's SRAM */
958
	if (pieces.inst_size > hw_params(priv).max_inst_size) {
959 960
		IWL_ERR(priv, "uCode instr len %Zd too large to fit in\n",
			pieces.inst_size);
961
		goto try_again;
Z
Zhu Yi 已提交
962 963
	}

964
	if (pieces.data_size > hw_params(priv).max_data_size) {
965 966
		IWL_ERR(priv, "uCode data len %Zd too large to fit in\n",
			pieces.data_size);
967
		goto try_again;
Z
Zhu Yi 已提交
968
	}
969

970
	if (pieces.init_size > hw_params(priv).max_inst_size) {
971 972
		IWL_ERR(priv, "uCode init instr len %Zd too large to fit in\n",
			pieces.init_size);
973
		goto try_again;
Z
Zhu Yi 已提交
974
	}
975

976
	if (pieces.init_data_size > hw_params(priv).max_data_size) {
977 978
		IWL_ERR(priv, "uCode init data len %Zd too large to fit in\n",
			pieces.init_data_size);
979
		goto try_again;
Z
Zhu Yi 已提交
980
	}
981

Z
Zhu Yi 已提交
982 983 984 985 986
	/* 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 */
987
	if (iwl_alloc_fw_desc(bus(priv), &trans(priv)->ucode_rt.code,
988 989
			      pieces.inst, pieces.inst_size))
		goto err_pci_alloc;
990
	if (iwl_alloc_fw_desc(bus(priv), &trans(priv)->ucode_rt.data,
991
			      pieces.data, pieces.data_size))
992 993
		goto err_pci_alloc;

Z
Zhu Yi 已提交
994
	/* Initialization instructions and data */
995
	if (pieces.init_size && pieces.init_data_size) {
996
		if (iwl_alloc_fw_desc(bus(priv), &trans(priv)->ucode_init.code,
997 998
				      pieces.init, pieces.init_size))
			goto err_pci_alloc;
999
		if (iwl_alloc_fw_desc(bus(priv), &trans(priv)->ucode_init.data,
1000
				      pieces.init_data, pieces.init_data_size))
1001 1002
			goto err_pci_alloc;
	}
Z
Zhu Yi 已提交
1003

J
Johannes Berg 已提交
1004 1005
	/* WoWLAN instructions and data */
	if (pieces.wowlan_inst_size && pieces.wowlan_data_size) {
1006 1007
		if (iwl_alloc_fw_desc(bus(priv),
				      &trans(priv)->ucode_wowlan.code,
J
Johannes Berg 已提交
1008 1009 1010
				      pieces.wowlan_inst,
				      pieces.wowlan_inst_size))
			goto err_pci_alloc;
1011 1012
		if (iwl_alloc_fw_desc(bus(priv),
				      &trans(priv)->ucode_wowlan.data,
J
Johannes Berg 已提交
1013 1014 1015 1016 1017
				      pieces.wowlan_data,
				      pieces.wowlan_data_size))
			goto err_pci_alloc;
	}

1018 1019 1020 1021 1022 1023 1024
	/* 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 已提交
1025
	priv->init_evtlog_ptr = pieces.init_evtlog_ptr;
1026
	if (pieces.init_evtlog_size)
W
Wey-Yi Guy 已提交
1027
		priv->init_evtlog_size = (pieces.init_evtlog_size - 16)/12;
1028
	else
W
Wey-Yi Guy 已提交
1029
		priv->init_evtlog_size =
1030
			cfg(priv)->base_params->max_event_log_size;
W
Wey-Yi Guy 已提交
1031 1032
	priv->init_errlog_ptr = pieces.init_errlog_ptr;
	priv->inst_evtlog_ptr = pieces.inst_evtlog_ptr;
1033
	if (pieces.inst_evtlog_size)
W
Wey-Yi Guy 已提交
1034
		priv->inst_evtlog_size = (pieces.inst_evtlog_size - 16)/12;
1035
	else
W
Wey-Yi Guy 已提交
1036
		priv->inst_evtlog_size =
1037
			cfg(priv)->base_params->max_event_log_size;
W
Wey-Yi Guy 已提交
1038
	priv->inst_errlog_ptr = pieces.inst_errlog_ptr;
1039 1040 1041
#ifndef CONFIG_IWLWIFI_P2P
	ucode_capa.flags &= ~IWL_UCODE_TLV_FLAGS_PAN;
#endif
1042

1043 1044 1045
	priv->new_scan_threshold_behaviour =
		!!(ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWSCAN);

1046
	if (!(cfg(priv)->sku & EEPROM_SKU_CAP_IPAN_ENABLE))
1047
		ucode_capa.flags &= ~IWL_UCODE_TLV_FLAGS_PAN;
1048

1049 1050 1051 1052 1053 1054 1055
	/*
	 * if not PAN, then don't support P2P -- might be a uCode
	 * packaging bug or due to the eeprom check above
	 */
	if (!(ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN))
		ucode_capa.flags &= ~IWL_UCODE_TLV_FLAGS_P2P;

1056 1057
	if (ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN) {
		priv->sta_key_max_num = STA_KEY_MAX_NUM_PAN;
1058
		priv->shrd->cmd_queue = IWL_IPAN_CMD_QUEUE_NUM;
1059 1060
	} else {
		priv->sta_key_max_num = STA_KEY_MAX_NUM;
1061
		priv->shrd->cmd_queue = IWL_DEFAULT_CMD_QUEUE_NUM;
1062
	}
1063 1064 1065 1066 1067 1068 1069 1070 1071
	/*
	 * 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 已提交
1072
	priv->phy_calib_chain_noise_reset_cmd =
1073
		ucode_capa.standard_phy_calibration_size;
W
Wey-Yi Guy 已提交
1074
	priv->phy_calib_chain_noise_gain_cmd =
1075 1076
		ucode_capa.standard_phy_calibration_size + 1;

1077 1078 1079
	/* initialize all valid contexts */
	iwl_init_context(priv, ucode_capa.flags);

1080 1081 1082 1083 1084
	/**************************************************
	 * This is still part of probe() in a sense...
	 *
	 * 9. Setup and register with mac80211 and debugfs
	 **************************************************/
1085
	err = iwlagn_mac_setup_register(priv, &ucode_capa);
1086 1087 1088 1089 1090 1091 1092
	if (err)
		goto out_unbind;

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

Z
Zhu Yi 已提交
1093 1094
	/* We have our copies now, allow OS release its copies */
	release_firmware(ucode_raw);
W
Wey-Yi Guy 已提交
1095
	complete(&priv->firmware_loading_complete);
1096 1097 1098 1099 1100 1101 1102 1103
	return;

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

 err_pci_alloc:
1106
	IWL_ERR(priv, "failed to allocate pci memory\n");
1107
	iwl_dealloc_ucode(trans(priv));
1108
 out_unbind:
W
Wey-Yi Guy 已提交
1109
	complete(&priv->firmware_loading_complete);
1110
	device_release_driver(bus(priv)->dev);
Z
Zhu Yi 已提交
1111 1112 1113
	release_firmware(ucode_raw);
}

1114 1115 1116 1117 1118 1119 1120
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;

1121
	spin_lock_irqsave(&priv->shrd->lock, flags);
1122
	iwl_write32(bus(priv), CSR_UCODE_DRV_GP1_CLR,
1123
		    CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT);
1124
	spin_unlock_irqrestore(&priv->shrd->lock, flags);
1125 1126
	priv->thermal_throttle.ct_kill_toggle = false;

1127
	if (cfg(priv)->base_params->support_ct_kill_exit) {
1128
		adv_cmd.critical_temperature_enter =
1129
			cpu_to_le32(hw_params(priv).ct_kill_threshold);
1130
		adv_cmd.critical_temperature_exit =
1131
			cpu_to_le32(hw_params(priv).ct_kill_exit_threshold);
1132

1133
		ret = iwl_trans_send_cmd_pdu(trans(priv),
1134 1135
				       REPLY_CT_KILL_CONFIG_CMD,
				       CMD_SYNC, sizeof(adv_cmd), &adv_cmd);
1136 1137 1138 1139
		if (ret)
			IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
		else
			IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
1140 1141 1142 1143
				"succeeded, critical temperature enter is %d,"
				"exit is %d\n",
				hw_params(priv).ct_kill_threshold,
				hw_params(priv).ct_kill_exit_threshold);
1144 1145
	} else {
		cmd.critical_temperature_R =
1146
			cpu_to_le32(hw_params(priv).ct_kill_threshold);
1147

1148
		ret = iwl_trans_send_cmd_pdu(trans(priv),
1149 1150
				       REPLY_CT_KILL_CONFIG_CMD,
				       CMD_SYNC, sizeof(cmd), &cmd);
1151 1152 1153 1154
		if (ret)
			IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
		else
			IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
1155 1156 1157
				"succeeded, "
				"critical temperature is %d\n",
				hw_params(priv).ct_kill_threshold);
1158 1159 1160
	}
}

1161 1162 1163 1164 1165
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,
1166 1167
		.len = { sizeof(struct iwl_calib_cfg_cmd), },
		.data = { &calib_cfg_cmd, },
1168 1169 1170
	};

	memset(&calib_cfg_cmd, 0, sizeof(calib_cfg_cmd));
1171
	calib_cfg_cmd.ucd_calib_cfg.once.is_enable = IWL_CALIB_RT_CFG_ALL;
1172
	calib_cfg_cmd.ucd_calib_cfg.once.start = cpu_to_le32(cfg);
1173

1174
	return iwl_trans_send_cmd(trans(priv), &cmd);
1175 1176 1177
}


W
Wey-Yi Guy 已提交
1178 1179 1180 1181 1182 1183 1184 1185
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);
1186
		return iwl_trans_send_cmd_pdu(trans(priv),
W
Wey-Yi Guy 已提交
1187 1188 1189 1190 1191 1192 1193 1194 1195 1196
					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 已提交
1197
/**
1198
 * iwl_alive_start - called after REPLY_ALIVE notification received
Z
Zhu Yi 已提交
1199
 *                   from protocol/runtime uCode (initialization uCode's
1200
 *                   Alive gets handled by iwl_init_alive_start()).
Z
Zhu Yi 已提交
1201
 */
1202
int iwl_alive_start(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1203
{
1204
	int ret = 0;
1205
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
Z
Zhu Yi 已提交
1206

1207
	/*TODO: this should go to the transport layer */
1208
	iwl_reset_ict(trans(priv));
Z
Zhu Yi 已提交
1209

1210
	IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
1211

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

1215 1216
	/* Enable watchdog to monitor the driver tx queues */
	iwl_setup_watchdog(priv);
1217

1218
	if (iwl_is_rfkill(priv->shrd))
1219
		return -ERFKILL;
Z
Zhu Yi 已提交
1220

1221
	/* download priority table before any calibration request */
1222 1223
	if (cfg(priv)->bt_params &&
	    cfg(priv)->bt_params->advanced_bt_coexist) {
1224
		/* Configure Bluetooth device coexistence support */
1225
		if (cfg(priv)->bt_params->bt_sco_disable)
1226 1227 1228 1229
			priv->bt_enable_pspoll = false;
		else
			priv->bt_enable_pspoll = true;

1230 1231 1232
		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 已提交
1233
		iwlagn_send_advance_bt_config(priv);
1234
		priv->bt_valid = IWLAGN_BT_VALID_ENABLE_FLAGS;
1235 1236
		priv->cur_rssi_ctx = NULL;

1237
		iwl_send_prio_tbl(trans(priv));
1238 1239

		/* FIXME: w/a to force change uCode BT state machine */
1240
		ret = iwl_send_bt_env(trans(priv), IWL_BT_COEX_ENV_OPEN,
1241 1242 1243
					 BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
		if (ret)
			return ret;
1244
		ret = iwl_send_bt_env(trans(priv), IWL_BT_COEX_ENV_CLOSE,
1245 1246 1247
					 BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
		if (ret)
			return ret;
W
Wey-Yi Guy 已提交
1248 1249 1250 1251 1252
	} else {
		/*
		 * default is 2-wire BT coexexistence support
		 */
		iwl_send_bt_config(priv);
1253
	}
W
Wey-Yi Guy 已提交
1254

1255 1256 1257
	if (hw_params(priv).calib_rt_cfg)
		iwlagn_send_calib_cfg_rt(priv,
					 hw_params(priv).calib_rt_cfg);
1258

1259
	ieee80211_wake_queues(priv->hw);
Z
Zhu Yi 已提交
1260

1261
	priv->active_rate = IWL_RATES_MASK;
Z
Zhu Yi 已提交
1262

1263
	/* Configure Tx antenna selection based on H/W config */
1264
	iwlagn_send_tx_ant_config(priv, cfg(priv)->valid_tx_ant);
1265

1266
	if (iwl_is_associated_ctx(ctx) && !priv->shrd->wowlan) {
G
Gregory Greenman 已提交
1267
		struct iwl_rxon_cmd *active_rxon =
1268
				(struct iwl_rxon_cmd *)&ctx->active;
1269
		/* apply any changes in staging */
1270
		ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
Z
Zhu Yi 已提交
1271 1272
		active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
	} else {
1273
		struct iwl_rxon_context *tmp;
Z
Zhu Yi 已提交
1274
		/* Initialize our rx_config data */
1275 1276
		for_each_context(priv, tmp)
			iwl_connection_init_rx_config(priv, tmp);
1277

W
Wey-Yi Guy 已提交
1278
		iwlagn_set_rxon_chain(priv, ctx);
Z
Zhu Yi 已提交
1279 1280
	}

1281
	if (!priv->shrd->wowlan) {
J
Johannes Berg 已提交
1282 1283 1284
		/* WoWLAN ucode will not reply in the same way, skip it */
		iwl_reset_run_time_calib(priv);
	}
1285

1286
	set_bit(STATUS_READY, &priv->shrd->status);
1287

Z
Zhu Yi 已提交
1288
	/* Configure the adapter for unassociated operation */
1289
	ret = iwlagn_commit_rxon(priv, ctx);
1290 1291
	if (ret)
		return ret;
Z
Zhu Yi 已提交
1292 1293

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

1296
	IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
1297

1298
	return iwl_power_update_mode(priv, true);
Z
Zhu Yi 已提交
1299 1300
}

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

1303
void __iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1304
{
1305
	int exit_pending;
Z
Zhu Yi 已提交
1306

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

1309 1310
	iwl_scan_cancel_timeout(priv, 200);

1311 1312 1313 1314 1315 1316 1317
	/*
	 * If active, scanning won't cancel it, so say it expired.
	 * No race since we hold the mutex here and a new one
	 * can't come in at this time.
	 */
	ieee80211_remain_on_channel_expired(priv->hw);

1318 1319
	exit_pending =
		test_and_set_bit(STATUS_EXIT_PENDING, &priv->shrd->status);
Z
Zhu Yi 已提交
1320

1321 1322
	/* Stop TX queues watchdog. We need to have STATUS_EXIT_PENDING bit set
	 * to prevent rearm timer */
1323
	del_timer_sync(&priv->watchdog);
1324

1325
	iwl_clear_ucode_stations(priv, NULL);
1326
	iwl_dealloc_bcast_stations(priv);
1327
	iwl_clear_driver_stations(priv);
Z
Zhu Yi 已提交
1328

1329
	/* reset BT coex data */
1330
	priv->bt_status = 0;
1331 1332
	priv->cur_rssi_ctx = NULL;
	priv->bt_is_sco = 0;
1333
	if (cfg(priv)->bt_params)
1334
		priv->bt_traffic_load =
1335
			 cfg(priv)->bt_params->bt_init_traffic_load;
1336 1337
	else
		priv->bt_traffic_load = 0;
1338 1339
	priv->bt_full_concurrent = false;
	priv->bt_ci_compliance = 0;
1340

Z
Zhu Yi 已提交
1341 1342 1343
	/* Wipe out the EXIT_PENDING status bit if we are not actually
	 * exiting the module */
	if (!exit_pending)
1344
		clear_bit(STATUS_EXIT_PENDING, &priv->shrd->status);
Z
Zhu Yi 已提交
1345

1346
	if (priv->mac80211_registered)
Z
Zhu Yi 已提交
1347 1348
		ieee80211_stop_queues(priv->hw);

1349 1350
	iwl_trans_stop_device(trans(priv));

J
Johannes Berg 已提交
1351
	/* Clear out all status bits but a few that are stable across reset */
1352 1353
	priv->shrd->status &=
			test_bit(STATUS_RF_KILL_HW, &priv->shrd->status) <<
Z
Zhu Yi 已提交
1354
				STATUS_RF_KILL_HW |
1355
			test_bit(STATUS_GEO_CONFIGURED, &priv->shrd->status) <<
1356
				STATUS_GEO_CONFIGURED |
1357
			test_bit(STATUS_FW_ERROR, &priv->shrd->status) <<
1358
				STATUS_FW_ERROR |
1359
			test_bit(STATUS_EXIT_PENDING, &priv->shrd->status) <<
1360
				STATUS_EXIT_PENDING;
Z
Zhu Yi 已提交
1361

1362
	dev_kfree_skb(priv->beacon_skb);
1363
	priv->beacon_skb = NULL;
Z
Zhu Yi 已提交
1364 1365
}

1366
void iwl_down(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1367
{
1368
	mutex_lock(&priv->shrd->mutex);
1369
	__iwl_down(priv);
1370
	mutex_unlock(&priv->shrd->mutex);
1371

1372
	iwl_cancel_deferred_work(priv);
Z
Zhu Yi 已提交
1373 1374 1375 1376 1377 1378 1379 1380
}

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

1381 1382 1383 1384 1385
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);

1386
	mutex_lock(&priv->shrd->mutex);
1387

1388 1389
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status) ||
	    test_bit(STATUS_SCANNING, &priv->shrd->status)) {
1390
		mutex_unlock(&priv->shrd->mutex);
1391 1392 1393 1394
		return;
	}

	if (priv->start_calib) {
1395 1396
		iwl_chain_noise_calibration(priv);
		iwl_sensitivity_calibration(priv);
1397 1398
	}

1399
	mutex_unlock(&priv->shrd->mutex);
1400 1401
}

1402
void iwlagn_prepare_restart(struct iwl_priv *priv)
J
Johannes Berg 已提交
1403 1404 1405 1406 1407 1408
{
	struct iwl_rxon_context *ctx;
	bool bt_full_concurrent;
	u8 bt_ci_compliance;
	u8 bt_load;
	u8 bt_status;
1409
	bool bt_is_sco;
J
Johannes Berg 已提交
1410

1411
	lockdep_assert_held(&priv->shrd->mutex);
J
Johannes Berg 已提交
1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429

	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;
1430
	bt_is_sco = priv->bt_is_sco;
J
Johannes Berg 已提交
1431 1432 1433 1434 1435 1436 1437

	__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;
1438
	priv->bt_is_sco = bt_is_sco;
J
Johannes Berg 已提交
1439 1440
}

1441
static void iwl_bg_restart(struct work_struct *data)
Z
Zhu Yi 已提交
1442
{
1443
	struct iwl_priv *priv = container_of(data, struct iwl_priv, restart);
Z
Zhu Yi 已提交
1444

1445
	if (test_bit(STATUS_EXIT_PENDING, &priv->shrd->status))
Z
Zhu Yi 已提交
1446 1447
		return;

1448
	if (test_and_clear_bit(STATUS_FW_ERROR, &priv->shrd->status)) {
1449
		mutex_lock(&priv->shrd->mutex);
J
Johannes Berg 已提交
1450
		iwlagn_prepare_restart(priv);
1451
		mutex_unlock(&priv->shrd->mutex);
1452
		iwl_cancel_deferred_work(priv);
J
Johannes Berg 已提交
1453 1454
		ieee80211_restart_hw(priv->hw);
	} else {
1455
		WARN_ON(1);
J
Johannes Berg 已提交
1456
	}
Z
Zhu Yi 已提交
1457 1458
}

1459 1460 1461



1462
void iwlagn_disable_roc(struct iwl_priv *priv)
1463
{
1464
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_PAN];
1465

1466
	lockdep_assert_held(&priv->shrd->mutex);
1467

1468 1469
	if (!priv->hw_roc_setup)
		return;
1470

1471 1472
	ctx->staging.dev_type = RXON_DEV_TYPE_P2P;
	ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
1473

1474
	priv->hw_roc_channel = NULL;
1475

1476
	memset(ctx->staging.node_addr, 0, ETH_ALEN);
1477

1478
	iwlagn_commit_rxon(priv, ctx);
1479

1480 1481
	ctx->is_active = false;
	priv->hw_roc_setup = false;
1482 1483
}

1484
static void iwlagn_disable_roc_work(struct work_struct *work)
Z
Zhu Yi 已提交
1485
{
1486 1487
	struct iwl_priv *priv = container_of(work, struct iwl_priv,
					     hw_roc_disable_work.work);
Z
Zhu Yi 已提交
1488

1489
	mutex_lock(&priv->shrd->mutex);
1490
	iwlagn_disable_roc(priv);
1491
	mutex_unlock(&priv->shrd->mutex);
Z
Zhu Yi 已提交
1492 1493
}

1494 1495 1496 1497 1498 1499 1500
/*****************************************************************************
 *
 * driver setup and teardown
 *
 *****************************************************************************/

static void iwl_setup_deferred_work(struct iwl_priv *priv)
Z
Zhu Yi 已提交
1501
{
1502
	priv->shrd->workqueue = create_singlethread_workqueue(DRV_NAME);
Z
Zhu Yi 已提交
1503

1504
	init_waitqueue_head(&priv->shrd->wait_command_queue);
M
Mohamed Abbas 已提交
1505

1506 1507 1508 1509 1510 1511 1512 1513
	INIT_WORK(&priv->restart, iwl_bg_restart);
	INIT_WORK(&priv->beacon_update, iwl_bg_beacon_update);
	INIT_WORK(&priv->run_time_calib_work, iwl_bg_run_time_calib_work);
	INIT_WORK(&priv->tx_flush, iwl_bg_tx_flush);
	INIT_WORK(&priv->bt_full_concurrency, iwl_bg_bt_full_concurrency);
	INIT_WORK(&priv->bt_runtime_config, iwl_bg_bt_runtime_config);
	INIT_DELAYED_WORK(&priv->hw_roc_disable_work,
			  iwlagn_disable_roc_work);
1514

1515
	iwl_setup_scan_deferred_work(priv);
1516

1517 1518
	if (cfg(priv)->lib->bt_setup_deferred_work)
		cfg(priv)->lib->bt_setup_deferred_work(priv);
1519

1520 1521 1522
	init_timer(&priv->statistics_periodic);
	priv->statistics_periodic.data = (unsigned long)priv;
	priv->statistics_periodic.function = iwl_bg_statistics_periodic;
1523

1524 1525 1526
	init_timer(&priv->ucode_trace);
	priv->ucode_trace.data = (unsigned long)priv;
	priv->ucode_trace.function = iwl_bg_ucode_trace;
M
Mohamed Abbas 已提交
1527

1528 1529 1530
	init_timer(&priv->watchdog);
	priv->watchdog.data = (unsigned long)priv;
	priv->watchdog.function = iwl_bg_watchdog;
Z
Zhu Yi 已提交
1531 1532
}

1533
static void iwl_cancel_deferred_work(struct iwl_priv *priv)
J
Johannes Berg 已提交
1534
{
1535 1536
	if (cfg(priv)->lib->cancel_deferred_work)
		cfg(priv)->lib->cancel_deferred_work(priv);
J
Johannes Berg 已提交
1537

1538 1539
	cancel_work_sync(&priv->run_time_calib_work);
	cancel_work_sync(&priv->beacon_update);
J
Johannes Berg 已提交
1540

1541
	iwl_cancel_scan_deferred_work(priv);
J
Johannes Berg 已提交
1542

1543 1544 1545
	cancel_work_sync(&priv->bt_full_concurrency);
	cancel_work_sync(&priv->bt_runtime_config);
	cancel_delayed_work_sync(&priv->hw_roc_disable_work);
J
Johannes Berg 已提交
1546

1547 1548 1549
	del_timer_sync(&priv->statistics_periodic);
	del_timer_sync(&priv->ucode_trace);
}
J
Johannes Berg 已提交
1550

1551 1552 1553 1554
static void iwl_init_hw_rates(struct iwl_priv *priv,
			      struct ieee80211_rate *rates)
{
	int i;
J
Johannes Berg 已提交
1555

1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
	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;
		}
J
Johannes Berg 已提交
1569 1570 1571
	}
}

1572
static int iwl_init_drv(struct iwl_priv *priv)
J
Johannes Berg 已提交
1573
{
1574
	int ret;
J
Johannes Berg 已提交
1575

1576
	spin_lock_init(&priv->shrd->sta_lock);
J
Johannes Berg 已提交
1577

1578
	mutex_init(&priv->shrd->mutex);
J
Johannes Berg 已提交
1579

1580
	INIT_LIST_HEAD(&trans(priv)->calib_results);
1581

1582 1583 1584
	priv->ieee_channels = NULL;
	priv->ieee_rates = NULL;
	priv->band = IEEE80211_BAND_2GHZ;
J
Johannes Berg 已提交
1585

1586 1587 1588 1589
	priv->iw_mode = NL80211_IFTYPE_STATION;
	priv->current_ht_config.smps = IEEE80211_SMPS_STATIC;
	priv->missed_beacon_threshold = IWL_MISSED_BEACON_THRESHOLD_DEF;
	priv->agg_tids_count = 0;
J
Johannes Berg 已提交
1590

1591 1592 1593 1594 1595
	/* 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;
J
Johannes Berg 已提交
1596

1597
	priv->rx_statistics_jiffies = jiffies;
J
Johannes Berg 已提交
1598

1599 1600
	/* Choose which receivers/antennas to use */
	iwlagn_set_rxon_chain(priv, &priv->contexts[IWL_RXON_CTX_BSS]);
J
Johannes Berg 已提交
1601

1602
	iwl_init_scan_params(priv);
J
Johannes Berg 已提交
1603

1604
	/* init bt coex */
1605 1606
	if (cfg(priv)->bt_params &&
	    cfg(priv)->bt_params->advanced_bt_coexist) {
1607 1608 1609 1610 1611 1612 1613
		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;
		priv->bt_on_thresh = BT_ON_THRESHOLD_DEF;
		priv->bt_duration = BT_DURATION_LIMIT_DEF;
		priv->dynamic_frag_thresh = BT_FRAG_THRESHOLD_DEF;
	}
J
Johannes Berg 已提交
1614

1615
	ret = iwl_init_channel_map(priv);
J
Johannes Berg 已提交
1616
	if (ret) {
1617 1618
		IWL_ERR(priv, "initializing regulatory failed: %d\n", ret);
		goto err;
J
Johannes Berg 已提交
1619 1620
	}

1621 1622 1623 1624 1625 1626
	ret = iwl_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);
J
Johannes Berg 已提交
1627

1628
	return 0;
J
Johannes Berg 已提交
1629

1630 1631 1632 1633 1634
err_free_channel_map:
	iwl_free_channel_map(priv);
err:
	return ret;
}
J
Johannes Berg 已提交
1635

1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648
static void iwl_uninit_drv(struct iwl_priv *priv)
{
	iwl_free_geos(priv);
	iwl_free_channel_map(priv);
	if (priv->tx_cmd_pool)
		kmem_cache_destroy(priv->tx_cmd_pool);
	kfree(priv->scan_cmd);
	kfree(priv->beacon_cmd);
	kfree(rcu_dereference_raw(priv->noa_data));
#ifdef CONFIG_IWLWIFI_DEBUGFS
	kfree(priv->wowlan_sram);
#endif
}
J
Johannes Berg 已提交
1649 1650 1651



1652 1653 1654 1655
static u32 iwl_hw_detect(struct iwl_priv *priv)
{
	return iwl_read32(bus(priv), CSR_HW_REV);
}
J
Johannes Berg 已提交
1656

1657 1658 1659
/* Size of one Rx buffer in host DRAM */
#define IWL_RX_BUF_SIZE_4K (4 * 1024)
#define IWL_RX_BUF_SIZE_8K (8 * 1024)
1660

1661 1662
static int iwl_set_hw_params(struct iwl_priv *priv)
{
D
Don Fry 已提交
1663
	if (iwlagn_mod_params.amsdu_size_8K)
1664 1665
		hw_params(priv).rx_page_order =
			get_order(IWL_RX_BUF_SIZE_8K);
1666
	else
1667 1668
		hw_params(priv).rx_page_order =
			get_order(IWL_RX_BUF_SIZE_4K);
1669

D
Don Fry 已提交
1670
	if (iwlagn_mod_params.disable_11n)
1671
		cfg(priv)->sku &= ~EEPROM_SKU_CAP_11N_ENABLE;
1672

1673
	hw_params(priv).num_ampdu_queues =
1674
		cfg(priv)->base_params->num_of_ampdu_queues;
1675
	hw_params(priv).shadow_reg_enable =
1676 1677 1678
		cfg(priv)->base_params->shadow_reg_enable;
	hw_params(priv).sku = cfg(priv)->sku;
	hw_params(priv).wd_timeout = cfg(priv)->base_params->wd_timeout;
1679

1680
	/* Device-specific setup */
1681
	return cfg(priv)->lib->set_hw_params(priv);
1682 1683
}

1684 1685


1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706
static void iwl_debug_config(struct iwl_priv *priv)
{
	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_DEBUG "
#ifdef CONFIG_IWLWIFI_DEBUG
		"enabled\n");
#else
		"disabled\n");
#endif
	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_DEBUGFS "
#ifdef CONFIG_IWLWIFI_DEBUGFS
		"enabled\n");
#else
		"disabled\n");
#endif
	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_DEVICE_TRACING "
#ifdef CONFIG_IWLWIFI_DEVICE_TRACING
		"enabled\n");
#else
		"disabled\n");
#endif

1707 1708
	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_DEVICE_TESTMODE "
#ifdef CONFIG_IWLWIFI_DEVICE_TESTMODE
1709 1710 1711
		"enabled\n");
#else
		"disabled\n");
1712 1713 1714 1715 1716 1717
#endif
	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_P2P "
#ifdef CONFIG_IWLWIFI_P2P
		"enabled\n");
#else
		"disabled\n");
1718 1719 1720
#endif
}

1721 1722
int iwl_probe(struct iwl_bus *bus, const struct iwl_trans_ops *trans_ops,
		struct iwl_cfg *cfg)
1723 1724 1725 1726
{
	int err = 0;
	struct iwl_priv *priv;
	struct ieee80211_hw *hw;
1727
	u16 num_mac;
1728 1729 1730 1731 1732
	u32 hw_rev;

	/************************
	 * 1. Allocating HW data
	 ************************/
D
Don Fry 已提交
1733
	hw = iwl_alloc_all();
1734
	if (!hw) {
D
Don Fry 已提交
1735
		pr_err("%s: Cannot allocate network device\n", cfg->name);
1736
		err = -ENOMEM;
1737 1738 1739
		goto out;
	}

1740
	priv = hw->priv;
1741
	priv->shrd = &priv->_shrd;
1742
	bus->shrd = priv->shrd;
1743 1744
	priv->shrd->bus = bus;
	priv->shrd->priv = priv;
1745

1746 1747 1748 1749 1750 1751
	priv->shrd->trans = trans_ops->alloc(priv->shrd);
	if (priv->shrd->trans == NULL) {
		err = -ENOMEM;
		goto out_free_traffic_mem;
	}

1752
	/* At this point both hw and priv are allocated. */
1753

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

1756 1757 1758
	/* what debugging capabilities we have */
	iwl_debug_config(priv);

1759
	IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
1760
	cfg(priv) = cfg;
1761

1762 1763
	/* is antenna coupling more than 35dB ? */
	priv->bt_ant_couple_ok =
1764 1765 1766
		(iwlagn_mod_params.ant_coupling >
			IWL_BT_ANTENNA_COUPLING_THRESHOLD) ?
			true : false;
1767

1768
	/* enable/disable bt channel inhibition */
1769
	priv->bt_ch_announce = iwlagn_mod_params.bt_ch_announce;
1770 1771
	IWL_DEBUG_INFO(priv, "BT channel inhibition is %s\n",
		       (priv->bt_ch_announce) ? "On" : "Off");
1772

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

1776
	/* these spin locks will be used in apm_ops.init and EEPROM access
M
Mohamed Abbas 已提交
1777 1778
	 * we should init now
	 */
1779
	spin_lock_init(&bus(priv)->reg_lock);
1780
	spin_lock_init(&priv->shrd->lock);
1781 1782 1783 1784 1785 1786

	/*
	 * 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
	 */
1787
	iwl_write32(bus(priv), CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
1788

1789 1790 1791
	/***********************
	 * 3. Read REV register
	 ***********************/
J
Johannes Berg 已提交
1792
	hw_rev = iwl_hw_detect(priv);
1793
	IWL_INFO(priv, "Detected %s, REV=0x%X\n",
1794
		cfg(priv)->name, hw_rev);
1795

1796
	err = iwl_trans_request_irq(trans(priv));
1797
	if (err)
1798
		goto out_free_trans;
1799

1800
	if (iwl_trans_prepare_card_hw(trans(priv))) {
1801
		err = -EIO;
M
Mohamed Abbas 已提交
1802
		IWL_WARN(priv, "Failed, HW not ready\n");
1803
		goto out_free_trans;
M
Mohamed Abbas 已提交
1804 1805
	}

T
Tomas Winkler 已提交
1806 1807 1808
	/*****************
	 * 4. Read EEPROM
	 *****************/
1809
	/* Read the EEPROM */
J
Johannes Berg 已提交
1810
	err = iwl_eeprom_init(priv, hw_rev);
1811
	if (err) {
1812
		IWL_ERR(priv, "Unable to init EEPROM\n");
1813
		goto out_free_trans;
1814
	}
1815 1816
	err = iwl_eeprom_check_version(priv);
	if (err)
1817
		goto out_free_eeprom;
1818

1819 1820 1821 1822
	err = iwl_eeprom_check_sku(priv);
	if (err)
		goto out_free_eeprom;

1823
	/* extract MAC Address */
1824
	iwl_eeprom_get_mac(priv->shrd, priv->addresses[0].addr);
1825 1826 1827
	IWL_DEBUG_INFO(priv, "MAC address: %pM\n", priv->addresses[0].addr);
	priv->hw->wiphy->addresses = priv->addresses;
	priv->hw->wiphy->n_addresses = 1;
1828
	num_mac = iwl_eeprom_query16(priv->shrd, EEPROM_NUM_MAC_ADDRESS);
1829 1830 1831 1832 1833 1834
	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++;
	}
1835 1836 1837 1838

	/************************
	 * 5. Setup HW constants
	 ************************/
1839
	if (iwl_set_hw_params(priv)) {
1840
		err = -ENOENT;
1841
		IWL_ERR(priv, "failed to set hw parameters\n");
1842
		goto out_free_eeprom;
1843 1844 1845
	}

	/*******************
T
Tomas Winkler 已提交
1846
	 * 6. Setup priv
1847
	 *******************/
Z
Zhu Yi 已提交
1848

T
Tomas Winkler 已提交
1849
	err = iwl_init_drv(priv);
1850
	if (err)
R
Ron Rindjunsky 已提交
1851
		goto out_free_eeprom;
1852
	/* At this point both hw and priv are initialized. */
1853 1854

	/********************
1855
	 * 7. Setup services
1856
	 ********************/
1857
	iwl_setup_deferred_work(priv);
1858
	iwl_setup_rx_handlers(priv);
1859
	iwl_testmode_init(priv);
1860

J
Johannes Berg 已提交
1861
	/*********************************************
1862
	 * 8. Enable interrupts
J
Johannes Berg 已提交
1863
	 *********************************************/
T
Tomas Winkler 已提交
1864

1865
	iwl_enable_rfkill_int(priv);
1866 1867

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

J
Johannes Berg 已提交
1874
	wiphy_rfkill_set_hw_state(priv->hw->wiphy,
1875
		test_bit(STATUS_RF_KILL_HW, &priv->shrd->status));
1876

1877
	iwl_power_initialize(priv);
1878
	iwl_tt_initialize(priv);
J
Johannes Berg 已提交
1879

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

1882
	err = iwl_request_firmware(priv, true);
J
Johannes Berg 已提交
1883
	if (err)
1884
		goto out_destroy_workqueue;
J
Johannes Berg 已提交
1885

Z
Zhu Yi 已提交
1886 1887
	return 0;

1888
out_destroy_workqueue:
1889 1890
	destroy_workqueue(priv->shrd->workqueue);
	priv->shrd->workqueue = NULL;
T
Tomas Winkler 已提交
1891
	iwl_uninit_drv(priv);
1892
out_free_eeprom:
1893
	iwl_eeprom_free(priv->shrd);
1894
out_free_trans:
1895
	iwl_trans_free(trans(priv));
1896
out_free_traffic_mem:
1897
	iwl_free_traffic_mem(priv);
1898
	ieee80211_free_hw(priv->hw);
1899
out:
Z
Zhu Yi 已提交
1900 1901 1902
	return err;
}

1903
void __devexit iwl_remove(struct iwl_priv * priv)
Z
Zhu Yi 已提交
1904
{
W
Wey-Yi Guy 已提交
1905
	wait_for_completion(&priv->firmware_loading_complete);
1906

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

1909 1910
	iwl_dbgfs_unregister(priv);

1911
	/* ieee80211_unregister_hw call wil cause iwlagn_mac_stop to
1912
	 * to be called and iwl_down since we are removing the device
1913 1914
	 * we need to set STATUS_EXIT_PENDING bit.
	 */
1915
	set_bit(STATUS_EXIT_PENDING, &priv->shrd->status);
1916

W
Wey-Yi Guy 已提交
1917
	iwl_testmode_cleanup(priv);
1918
	iwlagn_mac_unregister(priv);
1919

1920 1921
	iwl_tt_exit(priv);

1922 1923
	/*This will stop the queues, move the device to low power state */
	iwl_trans_stop_device(trans(priv));
1924

1925
	iwl_dealloc_ucode(trans(priv));
Z
Zhu Yi 已提交
1926

1927
	iwl_eeprom_free(priv->shrd);
Z
Zhu Yi 已提交
1928

M
Mohamed Abbas 已提交
1929
	/*netif_stop_queue(dev); */
1930
	flush_workqueue(priv->shrd->workqueue);
M
Mohamed Abbas 已提交
1931

1932
	/* ieee80211_unregister_hw calls iwlagn_mac_stop, which flushes
1933
	 * priv->shrd->workqueue... so we can't take down the workqueue
Z
Zhu Yi 已提交
1934
	 * until now... */
1935 1936
	destroy_workqueue(priv->shrd->workqueue);
	priv->shrd->workqueue = NULL;
1937
	iwl_free_traffic_mem(priv);
Z
Zhu Yi 已提交
1938

1939
	iwl_trans_free(trans(priv));
1940

T
Tomas Winkler 已提交
1941
	iwl_uninit_drv(priv);
Z
Zhu Yi 已提交
1942

1943
	dev_kfree_skb(priv->beacon_skb);
Z
Zhu Yi 已提交
1944 1945 1946 1947 1948 1949 1950 1951 1952 1953

	ieee80211_free_hw(priv->hw);
}


/*****************************************************************************
 *
 * driver and module entry point
 *
 *****************************************************************************/
1954
static int __init iwl_init(void)
Z
Zhu Yi 已提交
1955 1956 1957
{

	int ret;
1958 1959
	pr_info(DRV_DESCRIPTION ", " DRV_VERSION "\n");
	pr_info(DRV_COPYRIGHT "\n");
1960

1961
	ret = iwlagn_rate_control_register();
1962
	if (ret) {
1963
		pr_err("Unable to register rate control algorithm: %d\n", ret);
1964 1965 1966
		return ret;
	}

1967
	ret = iwl_pci_register_driver();
Z
Zhu Yi 已提交
1968

1969 1970
	if (ret)
		goto error_register;
Z
Zhu Yi 已提交
1971
	return ret;
1972 1973

error_register:
1974
	iwlagn_rate_control_unregister();
1975
	return ret;
Z
Zhu Yi 已提交
1976 1977
}

1978
static void __exit iwl_exit(void)
Z
Zhu Yi 已提交
1979
{
1980
	iwl_pci_unregister_driver();
1981
	iwlagn_rate_control_unregister();
Z
Zhu Yi 已提交
1982 1983
}

1984 1985
module_exit(iwl_exit);
module_init(iwl_init);
1986 1987

#ifdef CONFIG_IWLWIFI_DEBUG
1988 1989
module_param_named(debug, iwlagn_mod_params.debug_level, uint,
		   S_IRUGO | S_IWUSR);
1990 1991 1992
MODULE_PARM_DESC(debug, "debug output mask");
#endif

1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003
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");
2004

2005 2006 2007
module_param_named(ucode_alternative,
		   iwlagn_mod_params.wanted_ucode_alternative,
		   int, S_IRUGO);
2008 2009
MODULE_PARM_DESC(ucode_alternative,
		 "specify ucode alternative to use from ucode file");
2010

2011 2012
module_param_named(antenna_coupling, iwlagn_mod_params.ant_coupling,
		   int, S_IRUGO);
2013 2014
MODULE_PARM_DESC(antenna_coupling,
		 "specify antenna coupling in dB (defualt: 0 dB)");
2015

2016 2017
module_param_named(bt_ch_inhibition, iwlagn_mod_params.bt_ch_announce,
		   bool, S_IRUGO);
2018
MODULE_PARM_DESC(bt_ch_inhibition,
2019
		 "Enable BT channel inhibition (default: enable)");
2020 2021 2022 2023 2024 2025

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])");
2026

2027
module_param_named(wd_disable, iwlagn_mod_params.wd_disable, int, S_IRUGO);
2028
MODULE_PARM_DESC(wd_disable,
2029 2030
		"Disable stuck queue watchdog timer 0=system default, "
		"1=disable, 2=enable (default: 0)");
2031

2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050
/*
 * 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)");
2051 2052 2053 2054

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)");
2055

2056 2057 2058 2059 2060
module_param_named(power_save, iwlagn_mod_params.power_save,
		bool, S_IRUGO);
MODULE_PARM_DESC(power_save,
		 "enable WiFi power management (default: disable)");

2061 2062 2063 2064 2065
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)");

2066 2067 2068 2069 2070
module_param_named(auto_agg, iwlagn_mod_params.auto_agg,
		bool, S_IRUGO);
MODULE_PARM_DESC(auto_agg,
		 "enable agg w/o check traffic load (default: enable)");

2071 2072 2073 2074 2075 2076 2077 2078 2079
/*
 * 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)");