iwl-agn.c 58.3 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 */

J
Johannes Berg 已提交
369
	base = priv->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 518
static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
{
	const char *name_pre = priv->cfg->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 = priv->cfg->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 535 536 537 538

	if (priv->fw_index < priv->cfg->ucode_api_min) {
		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
	const unsigned int api_max = priv->cfg->ucode_api_max;
840
	unsigned int api_ok = priv->cfg->ucode_api_ok;
841
	const unsigned int api_min = priv->cfg->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
			priv->cfg->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
			priv->cfg->base_params->max_event_log_size;
W
Wey-Yi Guy 已提交
1038
	priv->inst_errlog_ptr = pieces.inst_errlog_ptr;
1039

1040 1041 1042
	priv->new_scan_threshold_behaviour =
		!!(ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWSCAN);

1043 1044
	if (!(priv->cfg->sku & EEPROM_SKU_CAP_IPAN_ENABLE))
		ucode_capa.flags &= ~IWL_UCODE_TLV_FLAGS_PAN;
1045

1046 1047 1048 1049 1050 1051 1052
	/*
	 * 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;

1053 1054
	if (ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN) {
		priv->sta_key_max_num = STA_KEY_MAX_NUM_PAN;
1055
		priv->shrd->cmd_queue = IWL_IPAN_CMD_QUEUE_NUM;
1056 1057
	} else {
		priv->sta_key_max_num = STA_KEY_MAX_NUM;
1058
		priv->shrd->cmd_queue = IWL_DEFAULT_CMD_QUEUE_NUM;
1059
	}
J
Johannes Berg 已提交
1060

1061 1062 1063 1064 1065 1066 1067 1068 1069
	/*
	 * 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 已提交
1070
	priv->phy_calib_chain_noise_reset_cmd =
1071
		ucode_capa.standard_phy_calibration_size;
W
Wey-Yi Guy 已提交
1072
	priv->phy_calib_chain_noise_gain_cmd =
1073 1074
		ucode_capa.standard_phy_calibration_size + 1;

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

1078 1079 1080 1081 1082
	/**************************************************
	 * This is still part of probe() in a sense...
	 *
	 * 9. Setup and register with mac80211 and debugfs
	 **************************************************/
1083
	err = iwlagn_mac_setup_register(priv, &ucode_capa);
1084 1085 1086 1087 1088 1089 1090
	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 已提交
1091 1092
	/* We have our copies now, allow OS release its copies */
	release_firmware(ucode_raw);
W
Wey-Yi Guy 已提交
1093
	complete(&priv->firmware_loading_complete);
1094 1095 1096 1097 1098 1099 1100 1101
	return;

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

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

1112 1113 1114 1115 1116 1117 1118
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;

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

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

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

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

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

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

1172
	return iwl_trans_send_cmd(trans(priv), &cmd);
1173 1174 1175
}


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

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

1208
	IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
1209

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

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

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

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

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

1235
		iwl_send_prio_tbl(trans(priv));
1236 1237

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

1253 1254 1255
	if (hw_params(priv).calib_rt_cfg)
		iwlagn_send_calib_cfg_rt(priv,
					 hw_params(priv).calib_rt_cfg);
1256

1257
	ieee80211_wake_queues(priv->hw);
Z
Zhu Yi 已提交
1258

1259
	priv->active_rate = IWL_RATES_MASK;
Z
Zhu Yi 已提交
1260

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

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

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

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

1284
	set_bit(STATUS_READY, &priv->shrd->status);
1285

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

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

1294
	IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
1295

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

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

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

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

1307 1308
	iwl_scan_cancel_timeout(priv, 200);

1309 1310 1311 1312 1313 1314 1315
	/*
	 * 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);

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

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

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

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

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

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

1347 1348
	iwl_trans_stop_device(trans(priv));

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

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

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

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

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

1379 1380 1381 1382 1383
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);

1384
	mutex_lock(&priv->shrd->mutex);
1385

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

	if (priv->start_calib) {
1393 1394
		iwl_chain_noise_calibration(priv);
		iwl_sensitivity_calibration(priv);
1395 1396
	}

1397
	mutex_unlock(&priv->shrd->mutex);
1398 1399
}

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

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

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

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

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

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

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

1457 1458 1459



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

1464
	lockdep_assert_held(&priv->shrd->mutex);
1465

1466 1467
	if (!priv->hw_roc_setup)
		return;
1468

1469 1470
	ctx->staging.dev_type = RXON_DEV_TYPE_P2P;
	ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
1471

1472
	priv->hw_roc_channel = NULL;
1473

1474
	memset(ctx->staging.node_addr, 0, ETH_ALEN);
1475

1476
	iwlagn_commit_rxon(priv, ctx);
1477

1478 1479
	ctx->is_active = false;
	priv->hw_roc_setup = false;
1480 1481
}

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

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

1492 1493 1494 1495 1496 1497 1498
/*****************************************************************************
 *
 * driver setup and teardown
 *
 *****************************************************************************/

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

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

1504 1505 1506 1507 1508 1509 1510 1511
	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);
1512

1513
	iwl_setup_scan_deferred_work(priv);
1514

1515 1516
	if (priv->cfg->lib->bt_setup_deferred_work)
		priv->cfg->lib->bt_setup_deferred_work(priv);
1517

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

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

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

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

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

1539
	iwl_cancel_scan_deferred_work(priv);
J
Johannes Berg 已提交
1540

1541 1542 1543
	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 已提交
1544

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

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

1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566
	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 已提交
1567 1568 1569
	}
}

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

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

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

1578 1579
	INIT_LIST_HEAD(&priv->calib_results);

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

1584 1585 1586 1587
	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 已提交
1588

1589 1590 1591 1592 1593
	/* 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 已提交
1594

1595
	priv->rx_statistics_jiffies = jiffies;
J
Johannes Berg 已提交
1596

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

1600
	iwl_init_scan_params(priv);
J
Johannes Berg 已提交
1601

1602 1603 1604 1605 1606 1607 1608 1609 1610 1611
	/* init bt coex */
	if (priv->cfg->bt_params &&
	    priv->cfg->bt_params->advanced_bt_coexist) {
		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 已提交
1612

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

1619 1620 1621 1622 1623 1624
	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 已提交
1625

1626
	return 0;
J
Johannes Berg 已提交
1627

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

1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
static void iwl_uninit_drv(struct iwl_priv *priv)
{
	iwl_calib_free_results(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 已提交
1648 1649 1650



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

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

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

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

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

1679
	/* Device-specific setup */
1680
	return priv->cfg->lib->set_hw_params(priv);
1681 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 1707 1708 1709 1710 1711 1712 1713
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

	dev_printk(KERN_INFO, bus(priv)->dev, "CONFIG_IWLWIFI_DEVICE_SVTOOL "
#ifdef CONFIG_IWLWIFI_DEVICE_SVTOOL
		"enabled\n");
#else
		"disabled\n");
#endif
}

1714 1715
int iwl_probe(struct iwl_bus *bus, const struct iwl_trans_ops *trans_ops,
		struct iwl_cfg *cfg)
1716 1717 1718 1719
{
	int err = 0;
	struct iwl_priv *priv;
	struct ieee80211_hw *hw;
1720
	u16 num_mac;
1721 1722 1723 1724 1725
	u32 hw_rev;

	/************************
	 * 1. Allocating HW data
	 ************************/
D
Don Fry 已提交
1726
	hw = iwl_alloc_all();
1727
	if (!hw) {
D
Don Fry 已提交
1728
		pr_err("%s: Cannot allocate network device\n", cfg->name);
1729
		err = -ENOMEM;
1730 1731 1732
		goto out;
	}

1733
	priv = hw->priv;
1734
	priv->shrd = &priv->_shrd;
1735
	bus->shrd = priv->shrd;
1736 1737
	priv->shrd->bus = bus;
	priv->shrd->priv = priv;
1738

1739 1740 1741 1742 1743 1744
	priv->shrd->trans = trans_ops->alloc(priv->shrd);
	if (priv->shrd->trans == NULL) {
		err = -ENOMEM;
		goto out_free_traffic_mem;
	}

1745
	/* At this point both hw and priv are allocated. */
1746

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

1749 1750 1751
	/* what debugging capabilities we have */
	iwl_debug_config(priv);

1752
	IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
T
Tomas Winkler 已提交
1753
	priv->cfg = cfg;
1754

1755 1756
	/* is antenna coupling more than 35dB ? */
	priv->bt_ant_couple_ok =
1757 1758 1759
		(iwlagn_mod_params.ant_coupling >
			IWL_BT_ANTENNA_COUPLING_THRESHOLD) ?
			true : false;
1760

1761
	/* enable/disable bt channel inhibition */
1762
	priv->bt_ch_announce = iwlagn_mod_params.bt_ch_announce;
1763 1764
	IWL_DEBUG_INFO(priv, "BT channel inhibition is %s\n",
		       (priv->bt_ch_announce) ? "On" : "Off");
1765

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

1769
	/* these spin locks will be used in apm_ops.init and EEPROM access
M
Mohamed Abbas 已提交
1770 1771
	 * we should init now
	 */
1772
	spin_lock_init(&bus(priv)->reg_lock);
1773
	spin_lock_init(&priv->shrd->lock);
1774 1775 1776 1777 1778 1779

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

1782 1783 1784
	/***********************
	 * 3. Read REV register
	 ***********************/
J
Johannes Berg 已提交
1785
	hw_rev = iwl_hw_detect(priv);
1786
	IWL_INFO(priv, "Detected %s, REV=0x%X\n",
J
Johannes Berg 已提交
1787
		priv->cfg->name, hw_rev);
1788

1789
	err = iwl_trans_request_irq(trans(priv));
1790
	if (err)
1791
		goto out_free_trans;
1792

1793
	if (iwl_trans_prepare_card_hw(trans(priv))) {
1794
		err = -EIO;
M
Mohamed Abbas 已提交
1795
		IWL_WARN(priv, "Failed, HW not ready\n");
1796
		goto out_free_trans;
M
Mohamed Abbas 已提交
1797 1798
	}

T
Tomas Winkler 已提交
1799 1800 1801
	/*****************
	 * 4. Read EEPROM
	 *****************/
1802
	/* Read the EEPROM */
J
Johannes Berg 已提交
1803
	err = iwl_eeprom_init(priv, hw_rev);
1804
	if (err) {
1805
		IWL_ERR(priv, "Unable to init EEPROM\n");
1806
		goto out_free_trans;
1807
	}
1808 1809
	err = iwl_eeprom_check_version(priv);
	if (err)
1810
		goto out_free_eeprom;
1811

1812 1813 1814 1815
	err = iwl_eeprom_check_sku(priv);
	if (err)
		goto out_free_eeprom;

1816
	/* extract MAC Address */
1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827
	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++;
	}
1828 1829 1830 1831

	/************************
	 * 5. Setup HW constants
	 ************************/
1832
	if (iwl_set_hw_params(priv)) {
1833
		err = -ENOENT;
1834
		IWL_ERR(priv, "failed to set hw parameters\n");
1835
		goto out_free_eeprom;
1836 1837 1838
	}

	/*******************
T
Tomas Winkler 已提交
1839
	 * 6. Setup priv
1840
	 *******************/
Z
Zhu Yi 已提交
1841

T
Tomas Winkler 已提交
1842
	err = iwl_init_drv(priv);
1843
	if (err)
R
Ron Rindjunsky 已提交
1844
		goto out_free_eeprom;
1845
	/* At this point both hw and priv are initialized. */
1846 1847

	/********************
1848
	 * 7. Setup services
1849
	 ********************/
1850
	iwl_setup_deferred_work(priv);
1851
	iwl_setup_rx_handlers(priv);
1852
	iwl_testmode_init(priv);
1853

J
Johannes Berg 已提交
1854
	/*********************************************
1855
	 * 8. Enable interrupts
J
Johannes Berg 已提交
1856
	 *********************************************/
T
Tomas Winkler 已提交
1857

1858
	iwl_enable_rfkill_int(priv);
1859 1860

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

J
Johannes Berg 已提交
1867
	wiphy_rfkill_set_hw_state(priv->hw->wiphy,
1868
		test_bit(STATUS_RF_KILL_HW, &priv->shrd->status));
1869

1870
	iwl_power_initialize(priv);
1871
	iwl_tt_initialize(priv);
J
Johannes Berg 已提交
1872

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

1875
	err = iwl_request_firmware(priv, true);
J
Johannes Berg 已提交
1876
	if (err)
1877
		goto out_destroy_workqueue;
J
Johannes Berg 已提交
1878

Z
Zhu Yi 已提交
1879 1880
	return 0;

1881
out_destroy_workqueue:
1882 1883
	destroy_workqueue(priv->shrd->workqueue);
	priv->shrd->workqueue = NULL;
T
Tomas Winkler 已提交
1884
	iwl_uninit_drv(priv);
1885
out_free_eeprom:
1886
	iwl_eeprom_free(priv);
1887
out_free_trans:
1888
	iwl_trans_free(trans(priv));
1889
out_free_traffic_mem:
1890
	iwl_free_traffic_mem(priv);
1891
	ieee80211_free_hw(priv->hw);
1892
out:
Z
Zhu Yi 已提交
1893 1894 1895
	return err;
}

1896
void __devexit iwl_remove(struct iwl_priv * priv)
Z
Zhu Yi 已提交
1897
{
W
Wey-Yi Guy 已提交
1898
	wait_for_completion(&priv->firmware_loading_complete);
1899

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

1902 1903
	iwl_dbgfs_unregister(priv);

1904
	/* ieee80211_unregister_hw call wil cause iwlagn_mac_stop to
1905
	 * to be called and iwl_down since we are removing the device
1906 1907
	 * we need to set STATUS_EXIT_PENDING bit.
	 */
1908
	set_bit(STATUS_EXIT_PENDING, &priv->shrd->status);
1909

W
Wey-Yi Guy 已提交
1910
	iwl_testmode_cleanup(priv);
1911 1912
	iwl_leds_exit(priv);

1913
	if (priv->mac80211_registered) {
1914
		ieee80211_unregister_hw(priv->hw);
1915
		priv->mac80211_registered = 0;
1916 1917
	}

1918 1919
	iwl_tt_exit(priv);

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

1923
	iwl_dealloc_ucode(trans(priv));
Z
Zhu Yi 已提交
1924

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

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

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

1937
	iwl_trans_free(trans(priv));
1938

T
Tomas Winkler 已提交
1939
	iwl_uninit_drv(priv);
Z
Zhu Yi 已提交
1940

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

	ieee80211_free_hw(priv->hw);
}


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

	int ret;
1956 1957
	pr_info(DRV_DESCRIPTION ", " DRV_VERSION "\n");
	pr_info(DRV_COPYRIGHT "\n");
1958

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

1965
	ret = iwl_pci_register_driver();
Z
Zhu Yi 已提交
1966

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

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

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

1982 1983
module_exit(iwl_exit);
module_init(iwl_init);
1984 1985

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

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

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

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

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

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

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

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

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

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

2059 2060 2061 2062 2063
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)");

2064 2065 2066 2067 2068
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)");

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