init.c 17.0 KB
Newer Older
L
Luciano Coelho 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
/*
 * This file is part of wl1271
 *
 * Copyright (C) 2009 Nokia Corporation
 *
 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 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 St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 *
 */

#include <linux/kernel.h>
#include <linux/module.h>
26
#include <linux/slab.h>
L
Luciano Coelho 已提交
27

28
#include "debug.h"
S
Shahar Levi 已提交
29
#include "init.h"
L
Luciano Coelho 已提交
30
#include "wl12xx_80211.h"
S
Shahar Levi 已提交
31 32
#include "acx.h"
#include "cmd.h"
A
Arik Nemtsov 已提交
33
#include "tx.h"
34
#include "io.h"
L
Luciano Coelho 已提交
35

36
int wl1271_init_templates_config(struct wl1271 *wl)
L
Luciano Coelho 已提交
37
{
38
	int ret, i;
39
	size_t max_size;
L
Luciano Coelho 已提交
40 41

	/* send empty templates for fw memory reservation */
42 43
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_CFG_PROBE_REQ_2_4, NULL,
44
				      WL1271_CMD_TEMPL_MAX_SIZE,
45
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
46 47 48
	if (ret < 0)
		return ret;

49 50
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_CFG_PROBE_REQ_5,
51
				      NULL, WL1271_CMD_TEMPL_MAX_SIZE, 0,
52 53 54
				      WL1271_RATE_AUTOMATIC);
	if (ret < 0)
		return ret;
55

56 57
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_NULL_DATA, NULL,
58
				      sizeof(struct wl12xx_null_data_template),
59
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
60 61 62
	if (ret < 0)
		return ret;

63 64
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_PS_POLL, NULL,
65
				      sizeof(struct wl12xx_ps_poll_template),
66
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
67 68 69
	if (ret < 0)
		return ret;

70 71
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_QOS_NULL_DATA, NULL,
L
Luciano Coelho 已提交
72
				      sizeof
73
				      (struct ieee80211_qos_hdr),
74
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
75 76 77
	if (ret < 0)
		return ret;

78 79
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_PROBE_RESPONSE, NULL,
80
				      WL1271_CMD_TEMPL_DFLT_SIZE,
81
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
82 83 84
	if (ret < 0)
		return ret;

85 86
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_BEACON, NULL,
87
				      WL1271_CMD_TEMPL_DFLT_SIZE,
88
				      0, WL1271_RATE_AUTOMATIC);
L
Luciano Coelho 已提交
89 90 91
	if (ret < 0)
		return ret;

92 93
	max_size = sizeof(struct wl12xx_arp_rsp_template) +
		   WL1271_EXTRA_SPACE_MAX;
94 95
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_ARP_RSP, NULL,
96
				      max_size,
E
Eliad Peller 已提交
97 98 99 100
				      0, WL1271_RATE_AUTOMATIC);
	if (ret < 0)
		return ret;

101 102 103 104
	/*
	 * Put very large empty placeholders for all templates. These
	 * reserve memory for later.
	 */
105 106
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_AP_PROBE_RESPONSE, NULL,
107 108 109 110 111
				      WL1271_CMD_TEMPL_MAX_SIZE,
				      0, WL1271_RATE_AUTOMATIC);
	if (ret < 0)
		return ret;

112 113
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_AP_BEACON, NULL,
114 115 116 117 118
				      WL1271_CMD_TEMPL_MAX_SIZE,
				      0, WL1271_RATE_AUTOMATIC);
	if (ret < 0)
		return ret;

119 120
	ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
				      CMD_TEMPL_DEAUTH_AP, NULL,
121 122 123 124 125 126
				      sizeof
				      (struct wl12xx_disconn_template),
				      0, WL1271_RATE_AUTOMATIC);
	if (ret < 0)
		return ret;

127
	for (i = 0; i < CMD_TEMPL_KLV_IDX_MAX; i++) {
128 129
		ret = wl1271_cmd_template_set(wl, WL12XX_INVALID_ROLE_ID,
					      CMD_TEMPL_KLV, NULL,
130 131
					      sizeof(struct ieee80211_qos_hdr),
					      i, WL1271_RATE_AUTOMATIC);
132 133 134 135
		if (ret < 0)
			return ret;
	}

L
Luciano Coelho 已提交
136 137 138
	return 0;
}

E
Eliad Peller 已提交
139 140
static int wl1271_ap_init_deauth_template(struct wl1271 *wl,
					  struct wl12xx_vif *wlvif)
A
Arik Nemtsov 已提交
141 142 143
{
	struct wl12xx_disconn_template *tmpl;
	int ret;
144
	u32 rate;
A
Arik Nemtsov 已提交
145 146 147 148 149 150 151 152 153 154

	tmpl = kzalloc(sizeof(*tmpl), GFP_KERNEL);
	if (!tmpl) {
		ret = -ENOMEM;
		goto out;
	}

	tmpl->header.frame_ctl = cpu_to_le16(IEEE80211_FTYPE_MGMT |
					     IEEE80211_STYPE_DEAUTH);

E
Eliad Peller 已提交
155
	rate = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
156 157
	ret = wl1271_cmd_template_set(wl, wlvif->role_id,
				      CMD_TEMPL_DEAUTH_AP,
158
				      tmpl, sizeof(*tmpl), 0, rate);
A
Arik Nemtsov 已提交
159 160 161 162 163 164

out:
	kfree(tmpl);
	return ret;
}

165 166
static int wl1271_ap_init_null_template(struct wl1271 *wl,
					struct ieee80211_vif *vif)
A
Arik Nemtsov 已提交
167
{
E
Eliad Peller 已提交
168
	struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
A
Arik Nemtsov 已提交
169 170
	struct ieee80211_hdr_3addr *nullfunc;
	int ret;
171
	u32 rate;
A
Arik Nemtsov 已提交
172 173 174 175 176 177 178 179 180 181 182 183 184

	nullfunc = kzalloc(sizeof(*nullfunc), GFP_KERNEL);
	if (!nullfunc) {
		ret = -ENOMEM;
		goto out;
	}

	nullfunc->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
					      IEEE80211_STYPE_NULLFUNC |
					      IEEE80211_FCTL_FROMDS);

	/* nullfunc->addr1 is filled by FW */

185 186
	memcpy(nullfunc->addr2, vif->addr, ETH_ALEN);
	memcpy(nullfunc->addr3, vif->addr, ETH_ALEN);
A
Arik Nemtsov 已提交
187

E
Eliad Peller 已提交
188
	rate = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
189 190
	ret = wl1271_cmd_template_set(wl, wlvif->role_id,
				      CMD_TEMPL_NULL_DATA, nullfunc,
191
				      sizeof(*nullfunc), 0, rate);
A
Arik Nemtsov 已提交
192 193 194 195 196 197

out:
	kfree(nullfunc);
	return ret;
}

198 199
static int wl1271_ap_init_qos_null_template(struct wl1271 *wl,
					    struct ieee80211_vif *vif)
A
Arik Nemtsov 已提交
200
{
E
Eliad Peller 已提交
201
	struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
A
Arik Nemtsov 已提交
202 203
	struct ieee80211_qos_hdr *qosnull;
	int ret;
204
	u32 rate;
A
Arik Nemtsov 已提交
205 206 207 208 209 210 211 212 213 214 215 216 217

	qosnull = kzalloc(sizeof(*qosnull), GFP_KERNEL);
	if (!qosnull) {
		ret = -ENOMEM;
		goto out;
	}

	qosnull->frame_control = cpu_to_le16(IEEE80211_FTYPE_DATA |
					     IEEE80211_STYPE_QOS_NULLFUNC |
					     IEEE80211_FCTL_FROMDS);

	/* qosnull->addr1 is filled by FW */

218 219
	memcpy(qosnull->addr2, vif->addr, ETH_ALEN);
	memcpy(qosnull->addr3, vif->addr, ETH_ALEN);
A
Arik Nemtsov 已提交
220

E
Eliad Peller 已提交
221
	rate = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
222 223
	ret = wl1271_cmd_template_set(wl, wlvif->role_id,
				      CMD_TEMPL_QOS_NULL_DATA, qosnull,
224
				      sizeof(*qosnull), 0, rate);
A
Arik Nemtsov 已提交
225 226 227 228 229 230

out:
	kfree(qosnull);
	return ret;
}

231
static int wl12xx_init_rx_config(struct wl1271 *wl)
A
Arik Nemtsov 已提交
232 233 234
{
	int ret;

235
	ret = wl1271_acx_rx_msdu_life_time(wl);
A
Arik Nemtsov 已提交
236 237 238 239 240 241
	if (ret < 0)
		return ret;

	return 0;
}

E
Eliad Peller 已提交
242 243
static int wl12xx_init_phy_vif_config(struct wl1271 *wl,
					    struct wl12xx_vif *wlvif)
L
Luciano Coelho 已提交
244 245 246
{
	int ret;

E
Eliad Peller 已提交
247
	ret = wl1271_acx_slot(wl, wlvif, DEFAULT_SLOT_TIME);
L
Luciano Coelho 已提交
248 249 250
	if (ret < 0)
		return ret;

E
Eliad Peller 已提交
251
	ret = wl1271_acx_service_period_timeout(wl, wlvif);
L
Luciano Coelho 已提交
252 253 254
	if (ret < 0)
		return ret;

E
Eliad Peller 已提交
255
	ret = wl1271_acx_rts_threshold(wl, wlvif, wl->hw->wiphy->rts_threshold);
L
Luciano Coelho 已提交
256 257 258 259 260 261
	if (ret < 0)
		return ret;

	return 0;
}

262 263
static int wl1271_init_sta_beacon_filter(struct wl1271 *wl,
					 struct wl12xx_vif *wlvif)
L
Luciano Coelho 已提交
264 265 266
{
	int ret;

267
	ret = wl1271_acx_beacon_filter_table(wl, wlvif);
L
Luciano Coelho 已提交
268 269 270
	if (ret < 0)
		return ret;

271 272
	/* enable beacon filtering */
	ret = wl1271_acx_beacon_filter_opt(wl, wlvif, true);
L
Luciano Coelho 已提交
273 274 275 276 277 278
	if (ret < 0)
		return ret;

	return 0;
}

279
int wl1271_init_pta(struct wl1271 *wl)
L
Luciano Coelho 已提交
280 281 282
{
	int ret;

283
	ret = wl12xx_acx_sg_cfg(wl);
L
Luciano Coelho 已提交
284 285 286
	if (ret < 0)
		return ret;

287
	ret = wl1271_acx_sg_enable(wl, wl->sg_enabled);
L
Luciano Coelho 已提交
288 289 290 291 292 293
	if (ret < 0)
		return ret;

	return 0;
}

294
int wl1271_init_energy_detection(struct wl1271 *wl)
L
Luciano Coelho 已提交
295 296 297 298 299 300 301 302 303 304
{
	int ret;

	ret = wl1271_acx_cca_threshold(wl);
	if (ret < 0)
		return ret;

	return 0;
}

E
Eliad Peller 已提交
305 306
static int wl1271_init_beacon_broadcast(struct wl1271 *wl,
					struct wl12xx_vif *wlvif)
L
Luciano Coelho 已提交
307 308 309
{
	int ret;

E
Eliad Peller 已提交
310
	ret = wl1271_acx_bcn_dtim_options(wl, wlvif);
L
Luciano Coelho 已提交
311 312 313 314 315 316
	if (ret < 0)
		return ret;

	return 0;
}

317 318 319 320
static int wl12xx_init_fwlog(struct wl1271 *wl)
{
	int ret;

321
	if (wl->quirks & WLCORE_QUIRK_FWLOG_NOT_IMPLEMENTED)
322 323 324 325 326 327 328 329 330
		return 0;

	ret = wl12xx_cmd_config_fwlog(wl);
	if (ret < 0)
		return ret;

	return 0;
}

331
/* generic sta initialization (non vif-specific) */
E
Eliad Peller 已提交
332
static int wl1271_sta_hw_init(struct wl1271 *wl, struct wl12xx_vif *wlvif)
A
Arik Nemtsov 已提交
333 334 335
{
	int ret;

336
	/* PS config */
E
Eliad Peller 已提交
337
	ret = wl12xx_acx_config_ps(wl, wlvif);
338 339 340
	if (ret < 0)
		return ret;

S
Shahar Levi 已提交
341 342 343 344 345
	/* FM WLAN coexistence */
	ret = wl1271_acx_fm_coex(wl);
	if (ret < 0)
		return ret;

E
Eliad Peller 已提交
346
	ret = wl1271_acx_sta_rate_policies(wl, wlvif);
A
Arik Nemtsov 已提交
347 348 349 350 351 352
	if (ret < 0)
		return ret;

	return 0;
}

E
Eliad Peller 已提交
353 354
static int wl1271_sta_hw_init_post_mem(struct wl1271 *wl,
				       struct ieee80211_vif *vif)
A
Arik Nemtsov 已提交
355
{
E
Eliad Peller 已提交
356
	struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
A
Arik Nemtsov 已提交
357 358 359 360
	int ret, i;

	/* disable all keep-alive templates */
	for (i = 0; i < CMD_TEMPL_KLV_IDX_MAX; i++) {
E
Eliad Peller 已提交
361
		ret = wl1271_acx_keep_alive_config(wl, wlvif, i,
A
Arik Nemtsov 已提交
362 363 364 365 366 367
						   ACX_KEEP_ALIVE_TPL_INVALID);
		if (ret < 0)
			return ret;
	}

	/* disable the keep-alive feature */
E
Eliad Peller 已提交
368
	ret = wl1271_acx_keep_alive_mode(wl, wlvif, false);
A
Arik Nemtsov 已提交
369 370 371 372 373 374
	if (ret < 0)
		return ret;

	return 0;
}

375
/* generic ap initialization (non vif-specific) */
E
Eliad Peller 已提交
376
static int wl1271_ap_hw_init(struct wl1271 *wl, struct wl12xx_vif *wlvif)
A
Arik Nemtsov 已提交
377
{
378
	int ret;
A
Arik Nemtsov 已提交
379

E
Eliad Peller 已提交
380
	ret = wl1271_init_ap_rates(wl, wlvif);
A
Arik Nemtsov 已提交
381 382 383 384 385 386
	if (ret < 0)
		return ret;

	return 0;
}

387
int wl1271_ap_init_templates(struct wl1271 *wl, struct ieee80211_vif *vif)
A
Arik Nemtsov 已提交
388
{
E
Eliad Peller 已提交
389
	struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
A
Arik Nemtsov 已提交
390 391
	int ret;

E
Eliad Peller 已提交
392
	ret = wl1271_ap_init_deauth_template(wl, wlvif);
A
Arik Nemtsov 已提交
393 394 395
	if (ret < 0)
		return ret;

396
	ret = wl1271_ap_init_null_template(wl, vif);
A
Arik Nemtsov 已提交
397 398 399
	if (ret < 0)
		return ret;

400
	ret = wl1271_ap_init_qos_null_template(wl, vif);
A
Arik Nemtsov 已提交
401 402 403
	if (ret < 0)
		return ret;

404 405 406 407
	/*
	 * when operating as AP we want to receive external beacons for
	 * configuring ERP protection.
	 */
E
Eliad Peller 已提交
408
	ret = wl1271_acx_beacon_filter_opt(wl, wlvif, false);
409 410 411
	if (ret < 0)
		return ret;

A
Arik Nemtsov 已提交
412 413 414
	return 0;
}

415 416
static int wl1271_ap_hw_init_post_mem(struct wl1271 *wl,
				      struct ieee80211_vif *vif)
417
{
418
	return wl1271_ap_init_templates(wl, vif);
419 420
}

E
Eliad Peller 已提交
421
int wl1271_init_ap_rates(struct wl1271 *wl, struct wl12xx_vif *wlvif)
422 423 424 425 426
{
	int i, ret;
	struct conf_tx_rate_class rc;
	u32 supported_rates;

E
Eliad Peller 已提交
427 428
	wl1271_debug(DEBUG_AP, "AP basic rate set: 0x%x",
		     wlvif->basic_rate_set);
429

E
Eliad Peller 已提交
430
	if (wlvif->basic_rate_set == 0)
431 432
		return -EINVAL;

E
Eliad Peller 已提交
433
	rc.enabled_rates = wlvif->basic_rate_set;
434 435 436
	rc.long_retry_limit = 10;
	rc.short_retry_limit = 10;
	rc.aflags = 0;
E
Eliad Peller 已提交
437
	ret = wl1271_acx_ap_rate_policy(wl, &rc, wlvif->ap.mgmt_rate_idx);
438 439 440 441
	if (ret < 0)
		return ret;

	/* use the min basic rate for AP broadcast/multicast */
E
Eliad Peller 已提交
442
	rc.enabled_rates = wl1271_tx_min_rate_get(wl, wlvif->basic_rate_set);
443 444 445
	rc.short_retry_limit = 10;
	rc.long_retry_limit = 10;
	rc.aflags = 0;
E
Eliad Peller 已提交
446
	ret = wl1271_acx_ap_rate_policy(wl, &rc, wlvif->ap.bcast_rate_idx);
447 448 449 450 451 452 453
	if (ret < 0)
		return ret;

	/*
	 * If the basic rates contain OFDM rates, use OFDM only
	 * rates for unicast TX as well. Else use all supported rates.
	 */
E
Eliad Peller 已提交
454
	if ((wlvif->basic_rate_set & CONF_TX_OFDM_RATES))
455 456 457 458
		supported_rates = CONF_TX_OFDM_RATES;
	else
		supported_rates = CONF_TX_AP_ENABLED_RATES;

459 460 461
	/* unconditionally enable HT rates */
	supported_rates |= CONF_TX_MCS_RATES;

462 463 464 465 466 467
	/* configure unicast TX rate classes */
	for (i = 0; i < wl->conf.tx.ac_conf_count; i++) {
		rc.enabled_rates = supported_rates;
		rc.short_retry_limit = 10;
		rc.long_retry_limit = 10;
		rc.aflags = 0;
E
Eliad Peller 已提交
468 469
		ret = wl1271_acx_ap_rate_policy(wl, &rc,
						wlvif->ap.ucast_rate_idx[i]);
470 471 472 473 474 475 476
		if (ret < 0)
			return ret;
	}

	return 0;
}

E
Eliad Peller 已提交
477
static int wl1271_set_ba_policies(struct wl1271 *wl, struct wl12xx_vif *wlvif)
L
Levi, Shahar 已提交
478 479
{
	/* Reset the BA RX indicators */
E
Eliad Peller 已提交
480
	wlvif->ba_allowed = true;
481
	wl->ba_rx_session_count = 0;
L
Levi, Shahar 已提交
482

483
	/* BA is supported in STA/AP modes */
E
Eliad Peller 已提交
484 485
	if (wlvif->bss_type != BSS_TYPE_AP_BSS &&
	    wlvif->bss_type != BSS_TYPE_STA_BSS) {
E
Eliad Peller 已提交
486
		wlvif->ba_support = false;
487 488
		return 0;
	}
L
Levi, Shahar 已提交
489

E
Eliad Peller 已提交
490
	wlvif->ba_support = true;
L
Levi, Shahar 已提交
491

492
	/* 802.11n initiator BA session setting */
E
Eliad Peller 已提交
493
	return wl12xx_acx_set_ba_initiator_policy(wl, wlvif);
L
Levi, Shahar 已提交
494 495
}

496 497 498 499 500 501 502
int wl1271_chip_specific_init(struct wl1271 *wl)
{
	int ret = 0;

	if (wl->chip.id == CHIP_ID_1283_PG20) {
		u32 host_cfg_bitmap = HOST_IF_CFG_RX_FIFO_ENABLE;

503
		if (wl->quirks & WLCORE_QUIRK_TX_BLOCKSIZE_ALIGN)
504 505 506 507 508 509 510 511 512 513 514 515
			/* Enable SDIO padding */
			host_cfg_bitmap |= HOST_IF_CFG_TX_PAD_TO_SDIO_BLK;

		/* Must be before wl1271_acx_init_mem_config() */
		ret = wl1271_acx_host_if_cfg_bitmap(wl, host_cfg_bitmap);
		if (ret < 0)
			goto out;
	}
out:
	return ret;
}

516
/* vif-specifc initialization */
E
Eliad Peller 已提交
517
static int wl12xx_init_sta_role(struct wl1271 *wl, struct wl12xx_vif *wlvif)
518 519 520
{
	int ret;

E
Eliad Peller 已提交
521
	ret = wl1271_acx_group_address_tbl(wl, wlvif, true, NULL, 0);
522 523 524 525
	if (ret < 0)
		return ret;

	/* Initialize connection monitoring thresholds */
E
Eliad Peller 已提交
526
	ret = wl1271_acx_conn_monit_params(wl, wlvif, false);
527 528 529 530
	if (ret < 0)
		return ret;

	/* Beacon filtering */
531
	ret = wl1271_init_sta_beacon_filter(wl, wlvif);
532 533 534 535
	if (ret < 0)
		return ret;

	/* Beacons and broadcast settings */
E
Eliad Peller 已提交
536
	ret = wl1271_init_beacon_broadcast(wl, wlvif);
537 538
	if (ret < 0)
		return ret;
539

540
	/* Configure rssi/snr averaging weights */
E
Eliad Peller 已提交
541
	ret = wl1271_acx_rssi_snr_avg_weights(wl, wlvif);
542 543 544 545 546 547 548
	if (ret < 0)
		return ret;

	return 0;
}

/* vif-specific intialization */
E
Eliad Peller 已提交
549
static int wl12xx_init_ap_role(struct wl1271 *wl, struct wl12xx_vif *wlvif)
550 551 552
{
	int ret;

E
Eliad Peller 已提交
553
	ret = wl1271_acx_ap_max_tx_retry(wl, wlvif);
554 555 556 557
	if (ret < 0)
		return ret;

	/* initialize Tx power */
558
	ret = wl1271_acx_tx_power(wl, wlvif, wlvif->power_level);
559 560 561 562 563 564 565
	if (ret < 0)
		return ret;

	return 0;
}

int wl1271_init_vif_specific(struct wl1271 *wl, struct ieee80211_vif *vif)
L
Luciano Coelho 已提交
566
{
E
Eliad Peller 已提交
567
	struct wl12xx_vif *wlvif = wl12xx_vif_to_data(vif);
568
	struct conf_tx_ac_category *conf_ac;
569
	struct conf_tx_tid *conf_tid;
E
Eliad Peller 已提交
570
	bool is_ap = (wlvif->bss_type == BSS_TYPE_AP_BSS);
571 572
	int ret, i;

573 574 575 576 577 578 579 580 581 582 583
	/*
	 * consider all existing roles before configuring psm.
	 * TODO: reconfigure on interface removal.
	 */
	if (!wl->ap_count) {
		if (is_ap) {
			/* Configure for power always on */
			ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_CAM);
			if (ret < 0)
				return ret;
		} else if (!wl->sta_count) {
584 585 586 587 588 589 590 591 592 593 594
			if (wl->quirks & WLCORE_QUIRK_NO_ELP) {
				/* Configure for power always on */
				ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_CAM);
				if (ret < 0)
					return ret;
			} else {
				/* Configure for ELP power saving */
				ret = wl1271_acx_sleep_auth(wl, WL1271_PSM_ELP);
				if (ret < 0)
					return ret;
			}
595 596 597
		}
	}

598 599
	/* Mode specific init */
	if (is_ap) {
E
Eliad Peller 已提交
600
		ret = wl1271_ap_hw_init(wl, wlvif);
601 602 603
		if (ret < 0)
			return ret;

E
Eliad Peller 已提交
604
		ret = wl12xx_init_ap_role(wl, wlvif);
605 606 607
		if (ret < 0)
			return ret;
	} else {
E
Eliad Peller 已提交
608
		ret = wl1271_sta_hw_init(wl, wlvif);
609 610 611
		if (ret < 0)
			return ret;

E
Eliad Peller 已提交
612
		ret = wl12xx_init_sta_role(wl, wlvif);
613 614 615 616
		if (ret < 0)
			return ret;
	}

E
Eliad Peller 已提交
617
	wl12xx_init_phy_vif_config(wl, wlvif);
618 619 620 621 622

	/* Default TID/AC configuration */
	BUG_ON(wl->conf.tx.tid_conf_count != wl->conf.tx.ac_conf_count);
	for (i = 0; i < wl->conf.tx.tid_conf_count; i++) {
		conf_ac = &wl->conf.tx.ac_conf[i];
E
Eliad Peller 已提交
623 624 625
		ret = wl1271_acx_ac_cfg(wl, wlvif, conf_ac->ac,
					conf_ac->cw_min, conf_ac->cw_max,
					conf_ac->aifsn, conf_ac->tx_op_limit);
626 627 628 629
		if (ret < 0)
			return ret;

		conf_tid = &wl->conf.tx.tid_conf[i];
E
Eliad Peller 已提交
630
		ret = wl1271_acx_tid_cfg(wl, wlvif,
631 632 633 634 635 636 637 638 639 640 641 642
					 conf_tid->queue_id,
					 conf_tid->channel_type,
					 conf_tid->tsid,
					 conf_tid->ps_scheme,
					 conf_tid->ack_policy,
					 conf_tid->apsd_conf[0],
					 conf_tid->apsd_conf[1]);
		if (ret < 0)
			return ret;
	}

	/* Configure HW encryption */
E
Eliad Peller 已提交
643
	ret = wl1271_acx_feature_cfg(wl, wlvif);
644 645 646 647 648 649 650
	if (ret < 0)
		return ret;

	/* Mode specific init - post mem init */
	if (is_ap)
		ret = wl1271_ap_hw_init_post_mem(wl, vif);
	else
E
Eliad Peller 已提交
651
		ret = wl1271_sta_hw_init_post_mem(wl, vif);
652 653 654 655 656

	if (ret < 0)
		return ret;

	/* Configure initiator BA sessions policies */
E
Eliad Peller 已提交
657
	ret = wl1271_set_ba_policies(wl, wlvif);
658 659 660 661 662 663 664 665 666 667
	if (ret < 0)
		return ret;

	return 0;
}

int wl1271_hw_init(struct wl1271 *wl)
{
	int ret;

668
	if (wl->chip.id == CHIP_ID_1283_PG20) {
669
		ret = wl128x_cmd_general_parms(wl);
670 671
		if (ret < 0)
			return ret;
672
		ret = wl128x_cmd_radio_parms(wl);
673 674 675 676 677 678
		if (ret < 0)
			return ret;
	} else {
		ret = wl1271_cmd_general_parms(wl);
		if (ret < 0)
			return ret;
679
		ret = wl1271_cmd_radio_parms(wl);
680 681 682 683 684 685
		if (ret < 0)
			return ret;
		ret = wl1271_cmd_ext_radio_parms(wl);
		if (ret < 0)
			return ret;
	}
L
Luciano Coelho 已提交
686

687 688 689 690 691
	/* Chip-specific init */
	ret = wl1271_chip_specific_init(wl);
	if (ret < 0)
		return ret;

692 693 694 695
	/* Init templates */
	ret = wl1271_init_templates_config(wl);
	if (ret < 0)
		return ret;
696

697 698 699 700 701 702
	ret = wl12xx_acx_mem_cfg(wl);
	if (ret < 0)
		return ret;

	/* Configure the FW logger */
	ret = wl12xx_init_fwlog(wl);
L
Luciano Coelho 已提交
703 704 705
	if (ret < 0)
		return ret;

A
Arik Nemtsov 已提交
706 707 708 709 710
	/* Bluetooth WLAN coexistence */
	ret = wl1271_init_pta(wl);
	if (ret < 0)
		return ret;

L
Luciano Coelho 已提交
711 712 713 714 715 716
	/* Default memory configuration */
	ret = wl1271_acx_init_mem_config(wl);
	if (ret < 0)
		return ret;

	/* RX config */
E
Eliad Peller 已提交
717
	ret = wl12xx_init_rx_config(wl);
L
Luciano Coelho 已提交
718 719 720
	if (ret < 0)
		goto out_free_memmap;

721 722 723 724
	ret = wl1271_acx_dco_itrim_params(wl);
	if (ret < 0)
		goto out_free_memmap;

L
Luciano Coelho 已提交
725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
	/* Configure TX patch complete interrupt behavior */
	ret = wl1271_acx_tx_config_options(wl);
	if (ret < 0)
		goto out_free_memmap;

	/* RX complete interrupt pacing */
	ret = wl1271_acx_init_rx_interrupt(wl);
	if (ret < 0)
		goto out_free_memmap;

	/* Energy detection */
	ret = wl1271_init_energy_detection(wl);
	if (ret < 0)
		goto out_free_memmap;

	/* Default fragmentation threshold */
741
	ret = wl1271_acx_frag_threshold(wl, wl->hw->wiphy->frag_threshold);
L
Luciano Coelho 已提交
742 743 744 745
	if (ret < 0)
		goto out_free_memmap;

	/* Enable data path */
746
	ret = wl1271_cmd_data_path(wl, 1);
L
Luciano Coelho 已提交
747 748 749
	if (ret < 0)
		goto out_free_memmap;

750 751 752 753 754
	/* configure PM */
	ret = wl1271_acx_pm_config(wl);
	if (ret < 0)
		goto out_free_memmap;

755 756 757 758
	ret = wl12xx_acx_set_rate_mgmt_params(wl);
	if (ret < 0)
		goto out_free_memmap;

759 760 761 762 763
	/* configure hangover */
	ret = wl12xx_acx_config_hangover(wl);
	if (ret < 0)
		goto out_free_memmap;

L
Luciano Coelho 已提交
764 765 766 767
	return 0;

 out_free_memmap:
	kfree(wl->target_mem_map);
768
	wl->target_mem_map = NULL;
L
Luciano Coelho 已提交
769 770 771

	return ret;
}